JP2781078B2 - Insert / insert body removing method, insert / insert body attaching method and apparatus thereof, and insert / insert body attaching / detaching robot - Google Patents
Insert / insert body removing method, insert / insert body attaching method and apparatus thereof, and insert / insert body attaching / detaching robotInfo
- Publication number
- JP2781078B2 JP2781078B2 JP3097585A JP9758591A JP2781078B2 JP 2781078 B2 JP2781078 B2 JP 2781078B2 JP 3097585 A JP3097585 A JP 3097585A JP 9758591 A JP9758591 A JP 9758591A JP 2781078 B2 JP2781078 B2 JP 2781078B2
- Authority
- JP
- Japan
- Prior art keywords
- fitting
- fitting portion
- plug
- insert
- calculating
- 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.)
- Expired - Lifetime
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
- Sealing Of Jars (AREA)
Description
【0001】[0001]
【産業上の利用分野】この発明は、嵌挿体取外し方法お
よび嵌挿体取付け方法およびその装置並びに嵌挿体脱着
ロボットに関し、特に、停止位置がばらつく再生ドラム
缶等の充填孔を塞ぐネジ込みプラグを取外したり取付け
たりするのに好適である。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a method for removing a fitting, a method for attaching a fitting, and a device therefor, and a robot for removing a fitting. It is suitable for removing and attaching.
【0002】[0002]
【従来の技術】第14図は、ドラム缶の充填孔部分を示
す断面説明図である。2. Description of the Related Art FIG. 14 is an explanatory sectional view showing a filling hole portion of a drum can.
【0003】ドラム缶70は、天板71、胴板73およ
び図示しない底板から構成され、天板71に、円筒状の
プラグ装着部72が上方に突出して取付けてある。収容
物の充填孔Hは、プラグ装着部72の内部に形成され、
そこにプラグPをねじ込んで充填孔Hを塞ぐようになっ
ている。天板71には、さらに空気孔(図示省略)が設
けてある。The drum can 70 includes a top plate 71, a body plate 73, and a bottom plate (not shown). A cylindrical plug mounting portion 72 is attached to the top plate 71 so as to protrude upward. The filling hole H for the container is formed inside the plug mounting portion 72,
The plug P is screwed therein to close the filling hole H. The top plate 71 is further provided with air holes (not shown).
【0004】プラグPの嵌合部の外面には、プラグ装着
部72の内壁の雌ネジに噛合する雄ネジが形成してあ
り、上面には係止用突起Pbを有する凹部Paが形成し
てある。プラグPの嵌合部には、さらに密封用のOリン
グSが嵌入してある。プラグPをプラグ装着部72に取
付ける際には、プラグPをプラグ装着部72に着座させ
た後、適当なプラグ回転器具を凹部Paの係止用突起P
bに係止させてから右あるいは左に回転させて、ネジを
噛合させると共に締付けを行なう。プラグPをプラグ装
着部72から取外す際には、プラグ回転器具を係止用突
起Pbに係止させてから左あるいは右に回転させて噛合
を解除する。[0004] On the outer surface of the fitting portion of the plug P, there is formed a male screw that meshes with the female screw on the inner wall of the plug mounting portion 72, and on the upper surface, a recess Pa having a locking projection Pb is formed. is there. An O-ring S for sealing is further fitted into the fitting portion of the plug P. When the plug P is mounted on the plug mounting portion 72, the plug P is seated on the plug mounting portion 72, and then an appropriate plug rotating device is engaged with the locking projection P of the concave portion Pa.
b) and then rotate right or left to engage the screws and tighten. When removing the plug P from the plug mounting portion 72, the plug rotating device is locked to the locking projection Pb and then rotated left or right to release the engagement.
【0005】従って、ドラム缶70に収容物(例えば合
成樹脂)を充填する作業(以下、装缶という)では、
プラグ回転器具を凹部Paに係合して回転させ、プラグ
装着部72に噛合・締付けされたプラグPを取外す、
充填孔Hより収容物を充填する、プラグPをプラグ装
着部72に着座させてからプラグ回転器具で回転させ、
噛合させると共に所定トルクで締付ける、という3つの
工程が必要である。[0005] Therefore, in the operation of filling the drum 70 with the contents (for example, synthetic resin) (hereinafter referred to as a can),
The plug rotating device is engaged with the concave portion Pa and rotated, and the plug P engaged and fastened to the plug mounting portion 72 is removed.
After the plug P, which fills the contents from the filling hole H, is seated on the plug mounting portion 72, the plug P is rotated by a plug rotating device,
It is necessary to perform three steps of meshing and tightening with a predetermined torque.
【0006】ところで、従来より、例えば合成樹脂を収
容するのに、いわゆる再生ドラム缶が使用されている。
再生ドラム缶は、一度あるいは二度以上使用されたドラ
ム缶を回収し、洗浄・乾燥を行なって再度使用できるよ
うにしたものである。By the way, conventionally, a so-called regenerative drum can has been used for accommodating, for example, a synthetic resin.
The reclaimed drum is a drum that has been used once or twice or more, is collected, washed and dried, and can be reused.
【0007】再生ドラム缶は、天板71の湾曲、胴板7
3の膨張、底板の撓み等により、プラグ装着部72の位
置が横方向(天板に沿う方向)あるいは縦方向(天板に
直角な方向)にずれていたり、傾斜していたりしている
ことが多い。また、再生ドラム缶の高さ自体も変化して
いることが多い。[0007] The recycled drum can has a curved top plate 71,
The position of the plug mounting portion 72 is shifted or inclined in the horizontal direction (direction along the top plate) or the vertical direction (direction perpendicular to the top plate) due to the expansion of 3, the deflection of the bottom plate, or the like. There are many. In addition, the height of the recycled drum can itself often changes.
【0008】その程度は、例えば容量200リットルの
再生ドラム缶では、プラグ装着部72(充填孔H)の横
方向の位置ずれ範囲が約9mm、プラグ装着部72の傾
斜範囲が縦軸(天板に直角な軸)に対して約6゜、その
縦方向の位置ずれ範囲が約12mm、再生ドラム缶自体
の高さの変化範囲が約14mmである。For example, in a regenerative drum having a capacity of 200 liters, the lateral displacement range of the plug mounting portion 72 (filling hole H) is about 9 mm, and the inclination range of the plug mounting portion 72 is vertical axis (top plate). The vertical displacement range is about 12 mm, and the height change range of the drum itself is about 14 mm.
【0009】このようなプラグ位置および姿勢の変動幅
が大きい再生ドラム缶について、装缶作業を自動的に行
なう自動装缶装置は、従来より開発され使用されてい
る。[0009] An automatic can mounting apparatus for automatically performing a can mounting operation on such a regenerated drum can having a large fluctuation range of the plug position and attitude has been developed and used.
【0010】従来の自動装缶装置は、回転ローラ等によ
ってドラム缶70をその中心軸(垂直軸)の周りに回転
させるドラム缶回転手段と、そのドラム缶70のプラグ
装着部72の位置を検出する位置検知手段と、検知した
位置にエアドライバの回転軸の先端を移動してその回転
軸の先端をプラグPの凹部Paに係合させて回転するこ
とにより、プラグ装着部72に噛合・締付けされたプラ
グPの噛合を解き、あるいはプラグ装着部72に着座し
たプラグPをプラグ装着部72に噛合させて締付けるプ
ラグ回転手段と、噛合を解かれてプラグ装着部72上に
置かれているプラグPを把持して待避位置まで移送し、
また、プラグPを待避位置からプラグ装着部72まで移
送してそこに着座させるプラグ移送手段とを備えてい
る。In the conventional automatic can mounting apparatus, drum rotating means for rotating the drum 70 around its central axis (vertical axis) by a rotating roller or the like, and position detection for detecting the position of the plug mounting portion 72 of the drum 70 Means, the tip of the rotary shaft of the air driver is moved to the detected position, the tip of the rotary shaft is engaged with the recess Pa of the plug P, and the plug is engaged with the plug mounting portion 72 and rotated. A plug rotating means for disengaging the P or engaging the plug P seated on the plug mounting portion 72 with the plug mounting portion 72 and holding the plug P disengaged and placed on the plug mounting portion 72 And transfer to the evacuation position,
Further, there is provided a plug transfer means for transferring the plug P from the retracted position to the plug mounting portion 72 and seating it there.
【0011】上記ドラム缶回転手段は、ローラコンベア
等で装缶場所まで搬送されて来たドラム缶70を回転さ
せ、そのプラグ装着部72を所定の位置に停止させる。
上記位置検知手段は、センサにより、装缶場所で位置決
めされたドラム缶70のプラグ装着部72の水平方向の
位置を検知する。上記プラグ回転手段は、エアドライバ
の回転軸の向きが所定範囲内で変化できるように構成し
てあり、回転軸の先端がプラグPの凹部Paに係合した
際にプラグPの傾斜角に応じて受動的に変化する。The drum rotating means rotates the drum 70 conveyed to the loading place by a roller conveyor or the like, and stops the plug mounting portion 72 at a predetermined position.
The position detecting means detects the horizontal position of the plug mounting portion 72 of the drum 70 positioned at the can loading position by a sensor. The plug rotation means is configured such that the direction of the rotation axis of the air driver can be changed within a predetermined range, and according to the inclination angle of the plug P when the tip of the rotation axis is engaged with the recess Pa of the plug P. Change passively.
【0012】この従来の自動装缶装置を用いて装缶を行
なう場合、ドラム缶70はプラグ装着部72を上方に向
けて装缶場所まで搬送され、そこでエアドライバのほぼ
真下にプラグ装着部72が来るようにドラム缶回転手段
により位置決めされる。次に、位置検知手段によりプラ
グ装着部72の位置を検知し、その位置にエアドライバ
を下降してその回転軸の先端をプラグ装着部72に噛合
・締付けされたプラグPに係合させる。続いて、その回
転軸を回転させてプラグPの噛合を解く。噛合を解かれ
たプラグPは、プラグ移送手段によりプラグ装着部72
から待避位置まで移送される。そこで、収容物の充填を
行なう。充填が完了すると、プラグ移送手段によりプラ
グPをプラグ装着部72に着座させる。その後、そのプ
ラグPにエアドライバの回転軸を係合させてから回転さ
せ、プラグ装着部72にプラグPを噛合させると共に締
付けを行なう。こうして、装缶作業を終了する。When canning is performed using this conventional automatic can mounting apparatus, the drum can 70 is conveyed to the canning place with the plug mounting section 72 facing upward, where the plug mounting section 72 is located almost directly below the air driver. Are positioned by the drum rotating means. Next, the position of the plug mounting portion 72 is detected by the position detecting means, and the air driver is lowered to that position to engage the tip of the rotating shaft with the plug P meshed and fastened to the plug mounting portion 72. Subsequently, the rotation shaft is rotated to disengage the plug P. The disengaged plug P is moved to the plug mounting portion 72 by the plug transfer means.
Is transferred to the evacuation position. Therefore, the contents are filled. When the filling is completed, the plug P is seated on the plug mounting section 72 by the plug transfer means. Thereafter, the rotation shaft of the air driver is engaged with the plug P and then rotated, so that the plug P is engaged with the plug mounting portion 72 and tightening is performed. Thus, the can packaging work is completed.
【0013】関連する他の従来技術としては、ラジエー
タキャップ、オイルキャップ等のキャップを自動的にそ
の装着部から取外したり、装着部に取付けたりするキャ
ップ自動開閉装置がある(特開昭62−105788号
公報参照)。As another related prior art, there is an automatic cap opening / closing device for automatically removing a cap such as a radiator cap, an oil cap or the like from a mounting portion thereof or attaching the cap to the mounting portion (Japanese Patent Laid-Open No. Sho 62-105788). Reference).
【0014】[0014]
【発明が解決しようとする課題】上記従来の自動装缶装
置は、搬送されて来るドラム缶毎にプラグの位置および
姿勢を検知し、それに応じてエアドライバの回転軸の位
置および方向を調整してからプラグに係合させるもので
はない。また、エアドライバの回転軸が1回、回転を始
めて停止するまでの間に、プラグ装着部に着座したプラ
グの噛合から締付け完了までの作業を行なうようになっ
ている。このため、プラグの取外しができない場合があ
ったり、プラグの取付けはできたがその締付けトルクが
過大であったり過小であったりする不具合が頻発し、装
缶作業に対する信頼性が十分でないという問題がある。The above-mentioned conventional automatic can mounting apparatus detects the position and the posture of the plug for each of the conveyed drums, and adjusts the position and the direction of the rotary shaft of the air driver accordingly. It is not intended to engage with the plug. In addition, the operation from the engagement of the plug seated on the plug mounting portion to the completion of the tightening is performed until the rotation shaft of the air driver starts rotating once and stops. For this reason, the plug may not be removed, or the plug may be attached, but the tightening torque may be too large or too small. is there.
【0015】そこで、これに対処するため、装缶場所に
常時、作業員を配置してドラム缶70の位置決め状況を
監視し、異状があれば直ちに手作業でその修正を行なう
ことが必要となる。また、プラグの取付け終了後に、作
業員がプラグの実際の締付けトルクを手作業で検査し、
不具合があればそれを手作業で直す必要がある。従っ
て、作業の無人化を達成することは到底不可能である。Therefore, in order to cope with this, it is necessary to arrange an operator at the canning place at all times to monitor the positioning status of the drum 70, and to immediately correct any abnormalities by hand. Also, after the plug has been installed, the operator manually checks the actual tightening torque of the plug,
If there is a defect, it must be fixed manually. Therefore, it is impossible to achieve unmanned work.
【0016】特に、複数回使用したものを再生した再生
ドラム缶については、プラグ装着部の位置や方向の変化
が特に大きいため、信頼性はいっそう低下する。Particularly, in the case of a regenerated drum that has been used a plurality of times, the change in the position and direction of the plug mounting portion is particularly large, so that the reliability is further reduced.
【0017】上記特開昭62−105788号公報記載
のキャップ自動開閉装置は、キャップ装着部を所定位置
に精確に位置決めしてからキャップの取付けおよび取外
しを行なうため、上記従来の自動装缶装置と同様の問題
がある。The automatic cap opening / closing device described in Japanese Patent Application Laid-Open No. Sho 62-105788 discloses a conventional automatic can opening and closing device which is used to accurately position a cap mounting portion at a predetermined position before mounting and removing the cap. There is a similar problem.
【0018】そこで、この発明の目的は、嵌合部(例え
ばドラム缶のプラグ装着部)や、嵌合部に嵌挿された嵌
挿体(例えばドラム缶のプラグ)に位置ずれあるいは嵌
挿方向の変化があっても、嵌合部からの嵌挿体の取外し
や嵌合部への嵌挿体の取付けを高い信頼性をもって行な
うことができる、嵌挿体取外し方法および嵌挿体取付け
方法およびその装置並びに嵌挿体脱着ロボットを提供す
ることである。Accordingly, an object of the present invention is to displace or change the fitting direction (for example, a plug of a drum can) of a fitting portion (for example, a plug mounting portion of a drum can) or a fitting body (for example, a plug of a drum can) fitted to the fitting portion. Even if there is, the method of removing the insert, the method of attaching the insert, and the device thereof, which can remove the insert from the engagement portion and attach the insert to the engagement portion with high reliability. Another object of the present invention is to provide an insertion / removal robot.
【0019】[0019]
【0020】[0020]
【課題を解決するための手段】(1)この発明の嵌挿体
取外し方法は、基準面を有する基準部材を嵌挿体または
嵌合部に係合させるステップと、上記嵌挿体または嵌合
部に係合せしめられた上記基準部材の基準面を検出する
ステップと、検出した上記基準面の位置および傾斜方向
を算出するステップと、検出した上記基準面と上記嵌挿
体または嵌合部との位置関係を算出するステップと、算
出した上記基準面の位置および傾斜方向並びに上記位置
関係に基づいて上記嵌挿体の位置および嵌挿方向を算出
するステップと、算出した上記嵌挿体の位置および嵌挿
方向に応じて嵌挿体取外し手段を制御して上記嵌挿体を
上記嵌合部から取外すステップとを具備してなることを
特徴とする。この方法では、上記嵌合部に向けて照射し
た検査光を検知して、上記嵌挿体が上記嵌合部から取外
されたか否かを非接触で検査するステップをさらに含む
のが好ましい。嵌挿体取外し作業の信頼性がより向上す
るからである。 (1) A method for removing a fitting body according to the present invention includes the steps of:
A step of engaging with the fitting portion, and
Detecting a reference surface of the engaging combined crimped the reference member parts, calculating the position and direction of inclination of the reference plane detected, and detected the reference surface and the fitting interposer or the fitting portion calculating a positional relationship between, calculated
Calculating the position and inserting direction of the fitting interposer based on the position and the inclination direction and the positional relationship between the reference plane out, depending on the position and inserting direction of the calculated the fitting interposer fitted the fitting interposer controls the body removal means
Characterized by comprising comprises the steps of removing from the fitting portion. In this method, the irradiation
The inspection light is detected, and the fitting body is removed from the fitting part.
Further includes a step of contactlessly checking whether or not the
Is preferred. The reliability of the work of removing the insert is further improved
This is because that.
【0021】(2) この発明の嵌挿体取外し装置は、
基準面を有する基準部材を嵌挿体または嵌合部に係合さ
せる手段と、上記嵌挿体または嵌合部に係合せしめられ
た上記基準部材の基準面を検出する手段と、検出した上
記基準面の位置および傾斜方向を算出する手段と、検出
した上記基準面と上記嵌挿体または嵌合部との位置関係
を算出する手段と、算出した上記基準面の位置および傾
斜方向並びに上記位置関係に基づいて上記嵌挿体の位置
および嵌挿方向を算出する手段と、上記嵌挿体を上記嵌
合部から取外す作業を行なう嵌挿体取外し手段と、算出
した上記嵌挿体の位置および嵌挿方向に応じて上記嵌挿
体取外し手段を制御する制御手段とを具備してなること
を特徴とする。 この装置では、上記嵌合部に向けて照射
した検査光を検知して、上記嵌挿体が上記嵌合部から取
外されたか否かを非接触で検査する手段をさらに含むの
が好ましい。嵌挿体取外し作業の信頼性がより向上する
からである。 (2) The device for removing a fitting body according to the present invention
A reference member having a reference surface is engaged with the fitting body or the fitting portion.
Means for engaging with the fitting body or the fitting portion.
Means for detecting a reference surface of the reference member,
Means for calculating the position and inclination direction of the reference plane, and detection
Positional relationship between the reference surface and the inserted body or the fitted portion
Means for calculating the position and inclination of the calculated reference plane.
The position of the insertion body based on the oblique direction and the positional relationship
Means for calculating the insertion direction, and
Means for removing the insert from the joint and calculating
The insertion according to the position and the insertion direction of the insertion body.
Control means for controlling the body removing means
It is characterized by. In this device, the irradiation
Detected inspection light, and the inserted body is removed from the fitted part.
It further includes a means for non-contact inspection of whether or not it has been removed.
Is preferred. The reliability of the work of removing the insert is improved
Because.
【0022】(3) この発明の第1の嵌挿体取付け方
法は、基準面を有する基準部材を嵌合部に係合させるス
テップと、上記嵌合部に係合せしめられた上記基準部材
の基準面を検出するステップと、検出した上記基準面の
位置および傾斜方向を算出するステップと、検出した上
記基準面と上記嵌合部との位置関係を算出するステップ
と、算出した上記基準面の位置および傾斜方向並びに上
記位置関係に基づいて上記嵌合部の位置および嵌挿方向
を算出するステップと、算出した上記嵌合部の位置およ
び嵌挿方向に応じて嵌挿体取付け手段を制御して上記嵌
挿体を上記嵌合部に取付けるステップとを具備してなる
ことを特徴とする。 この第1の嵌挿体取付け方法では、
上記嵌合部に取付けられた上記嵌挿体の高さを検知して
その取付け状況を検査するステップをさらに含むのが好
ましい。嵌挿体取付け作業の信頼性がより向上するから
である。この発明の第2の嵌挿体取付け方法は、嵌合部
の基準面を検出するステップと、検出した上記基準面の
位置および傾斜方向を算出するステップと、検出した上
記基準面と上記嵌合部との位置関係を算出するステップ
と、算出した上記基準面の位置および傾斜方向並びに上
記位置関係に基づいて上記嵌合部の位置および嵌挿方向
を算出するステップと、算出した上記嵌合部の位置およ
び嵌挿方向に応じて嵌挿体取付け手段を制御して上記嵌
挿体を上記嵌合部に取付けるステップと、上記嵌合部に
取付けられた上記嵌挿体の高さを検知してその取付け状
況を検査するステップとを具備してなることを特徴とす
る。 これら第1および第2の嵌挿体取付け方法では、上
記嵌挿体が上記嵌合部に噛合して取付けるように構成し
てある場合には、上記嵌挿体を嵌合部に取付けるステッ
プにおいて、嵌合部に噛合された嵌挿体の締付けを少な
くとも3段階に分けて行なうのが好ましい。また、上記
嵌挿体を締付ける際にそのトルクを検知し、検知した値
を設定値と比較して締付けの良否を判定するのが好まし
い。(3) Mounting method of the first insert of the present invention
The method involves engaging a reference member having a reference surface with a fitting portion.
A step and the reference member engaged with the fitting portion
Detecting a reference plane of the reference plane;
Calculating the position and the tilt direction;
Calculating the positional relationship between the reference surface and the fitting portion
And the calculated position and inclination direction of the reference plane and the
The position and the insertion direction of the fitting portion based on the positional relationship
Calculating the position and the calculated position of the fitting portion.
The fitting control means is controlled in accordance with the
Attaching the insert to the fitting portion.
It is characterized by the following. In this first insertion method,
By detecting the height of the insert body attached to the fitting portion
Preferably, the method further includes a step of checking the mounting condition.
Good. Because the reliability of the insertion work is more improved
It is. According to a second method of mounting the insertion body of the present invention,
Detecting a reference plane of the reference plane;
Calculating the position and the tilt direction;
Calculating the positional relationship between the reference surface and the fitting portion
And the calculated position and inclination direction of the reference plane and the
The position and the insertion direction of the fitting portion based on the positional relationship
Calculating the position and the calculated position of the fitting portion.
The fitting control means is controlled in accordance with the
Attaching the insert to the fitting portion;
Detects the height of the attached insert and detects the
Inspecting the situation.
You. In the first and second methods of attaching the insert, when the insert is configured to be engaged with the fitting portion, in the step of attaching the insert to the fitting portion, It is preferable that the fastening of the fitting body engaged with the fitting portion be performed in at least three stages. Further, it is preferable that the torque is detected when tightening the insertion body, and the detected value is compared with a set value to determine whether the tightening is good or not.
【0023】(4) この発明の第1の嵌挿体取付け装
置は、基準面を有する基準部材を嵌合部に係合させる手
段と、上記嵌合部に係合せしめられた上記基準部材の基
準面を検出する手段と、検出した上記基準面の位置およ
び傾斜方向を算出する手段と、検出した上記基準面と上
記嵌合部との位置関係を算出する手段と、算出した上記
基準面の位置および傾斜方向並びに上記位置関係に基づ
いて上記嵌合部の位置および嵌挿方向を算出する手段
と、上記嵌挿体を上記嵌合部に取付ける作業を行なう嵌
挿体取付け手段と、算出した上記嵌合部の位置および嵌
挿方向に応じて上記嵌挿体取付け手段を制御する制御手
段とを具備してなることを特徴とする。 この第1の嵌挿
体取付け装置では、上記嵌合部に取付けられた上記嵌挿
体の高さを検知してその取付け状況を検査する手段をさ
らに含むのが好ましい。嵌挿体取付け作業の信頼性がよ
り向上するからである。 この発明の第2の嵌挿体取付け
装置は、嵌合部の基準面を検出する手段と、検出した上
記基準面の位置および傾斜方向を算出する手段と、検出
した上記基準面と上記嵌合部との位置関係を算出する手
段と、算出した上記基準面の位置および傾斜方向並びに
上記位置関係に基づいて上記嵌合部の位置および嵌挿方
向を算出する手段と、上記嵌挿体を上記嵌合部に取付け
る作業を行なう嵌挿体取付け手段と、算出した上記嵌合
部の位置および嵌挿方向に応じて上記嵌挿体取付け手段
を制御する制御手段と、上記嵌合部に取付けられた上記
嵌挿体の高さを検知してその取付け状況を検査する手段
とを具備してなることを特徴とする。 これら第1および
第2の嵌挿体取付け装置では、上記嵌挿体が上記嵌合部
に噛合して取付けるように構成してある場合には、上記
嵌挿体取付け手段が、嵌合部に噛合された嵌挿体の締付
けを少なくとも3段階に分けて行なうのが好ましい。ま
た、上記嵌挿体を締付ける際にそのトルクを検知し、検
知した値を設定値と比較して締付けの良否を判定する手
段を設けるのが好ましい。(4) The first fitting insertion device mounting device of the present invention is a hand for engaging a reference member having a reference surface with a fitting portion.
A step and a base of the reference member engaged with the fitting portion.
Means for detecting the reference plane, and the position and position of the detected reference plane.
Means for calculating the tilt direction and the tilt direction, and
Means for calculating the positional relationship with the fitting portion;
Based on the position and inclination direction of the reference plane and the above positional relationship
Means for calculating the position of the fitting portion and the fitting direction
And a work for attaching the fitting body to the fitting portion.
Insert body attaching means, calculated position and fit of the fitting portion
A control means for controlling the insertion member mounting means in accordance with the insertion direction;
And a step. This first insertion
In the body attachment device, the fitting insertion attached to the fitting portion
A means to detect the height of the body and check the mounting status
It is preferable to include them. High reliability of fitting work
It is because it improves. Mounting of the second insert of the present invention
The apparatus includes means for detecting a reference surface of the fitting portion,
Means for calculating the position and inclination direction of the reference plane, and detection
For calculating the positional relationship between the reference surface and the fitting portion.
Step, the calculated position and inclination direction of the reference plane, and
The position of the fitting portion and the method of fitting and insertion based on the positional relationship
Means for calculating the orientation and mounting the insert body to the fitting portion
Insert fitting means for performing the work
The above-mentioned insertion body attaching means according to the position of the part and the insertion direction
Control means for controlling the
Means for detecting the height of the insertion body and inspecting its mounting status
And characterized in that: These first and
In the second insertion member mounting device, when the insertion member is configured to be engaged with the engagement portion and mounted, the insertion member mounting means includes the engagement member engaged with the engagement portion. It is preferable to tighten the insert in at least three stages. Further, it is preferable to provide a means for detecting the torque when tightening the insertion body and comparing the detected value with a set value to determine whether the tightening is good or not.
【0024】(5) この発明の第1の嵌挿体脱着ロボ
ットは、基準面を有する基準部材を嵌挿体または嵌合部
に係合させる手段と、上記嵌挿体または嵌合部に係合せ
しめられた上記基準部材の基準面を検出する手段と検出
した上記基準面の位置および傾斜方向を算出する手段
と、検出した上記基準面と上記嵌挿体または嵌合部との
位置関係を算出する手段と、算出した上記基準面の位置
および傾斜方向並びに上記位置関係に基づいて上記嵌挿
体または嵌合部の位置および嵌挿方向を算出する手段
と、上記嵌挿体を上記嵌合部から取外す作業を行なう嵌
挿体取外し手段と、上記嵌挿体を上記嵌合部に取付ける
作業を行なう嵌挿体取付け手段と、算出した上記嵌挿体
または嵌合部の位置および嵌挿方向に応じて上記嵌挿体
取外し手段を制御する第1制御手段と、算出した上記嵌
挿体または嵌合部の位置および嵌挿方向に応じて上記嵌
挿体取付け手段を制御する第2制御手段とを具備してな
ることを特徴とする。この第1の嵌挿体脱着ロボットで
は、上記嵌合部に取付けられた上記嵌挿体の高さを検知
してその取付け状況を検査する手段をさらに含むのが好
ましい。また、上記嵌合部に向けて照射した検査光を検
知して、上記嵌挿体が上記嵌合部から取外されたか否か
を非接触で検査する手段をさらに含むのが好ましい。 こ
の発明の第2の嵌挿体脱着ロボットは、嵌挿体または嵌
合部の基準面を検出する手段と、検出した上記基準面の
位置および傾斜方向を算出する手段と、検出した上記基
準面と上記嵌挿体または嵌合部との位置関係を算出する
手段と、算出した上記基準面の位置および傾斜方向並び
に上記位置関係に基づいて上記嵌挿体または嵌合部の位
置および嵌挿方向を算出する手段と、上記嵌挿体を上記
嵌合部から取外す作業を行なう嵌挿体取外し手段と、上
記嵌挿体を上記嵌合部に取付ける作業を行なう嵌挿体取
付け手段と、算出した上記嵌挿体または嵌合部の位置お
よび嵌挿方向に応じて上記嵌挿体取外し手段を制御する
第1制御手段と、算出した上記嵌挿体または嵌合部の位
置および嵌挿方向に応じて上記嵌挿体取付け手段を制御
する第2制御手段と、上記嵌合部に取付けられた上記嵌
挿体の高さを検知してその取付け状況を検査する手段と
を具備してなることを特徴とする。 これら第1および第
2の嵌挿体脱着ロボットでは、上記嵌挿体が、上記嵌合
部に噛合して取付けるように構成してある場合は、上記
嵌挿体取付け・取外し手段が、嵌合部に噛合された嵌挿
体の締付けを少なくとも3段階に分けて行なうように構
成するのが好ましい。また、上記嵌挿体をネジ込む際に
そのトルクを検知し、検知した値を設定値と比較して締
付けの良否を判定する手段を設けるのが好ましい。(5) A first insertion / removal robot for insertion / removal of an insertion / removal body according to the present invention includes a reference member having a reference surface, a reference insertion / removal member or a coupling portion.
Means for engaging with the fitting insert or the fitting portion.
Means and detection for detecting the reference surface of the tightened reference member
For calculating the position and the inclination direction of the reference plane
Between the detected reference plane and the inserted body or the fitted portion.
Means for calculating the positional relationship, and the calculated position of the reference plane
And insertion based on the inclination direction and the positional relationship.
Means for calculating the position of the body or the fitting part and the fitting insertion direction
And a fitting for performing an operation of removing the fitting insert from the fitting portion.
Attachment removing means and attaching the fitted insert to the fitting portion
Fitting insert mounting means for performing the operation, and the calculated inserting insert
Or the above-mentioned insertion body according to the position of the insertion part and the insertion direction
First control means for controlling the removal means, and the calculated fitting
The above-mentioned fitting is performed according to the position of the
And a second control means for controlling the insert mounting means . With this first insertion / removal robot
Detects the height of the insert body attached to the fitting part
And further include means for inspecting its mounting condition.
Good. In addition, the inspection light irradiated toward the fitting part is detected.
Knows whether the insert has been removed from the fit
It is preferable to further include a means for inspecting the contactlessly. This
The second insertion / removal robot of the invention has
Means for detecting the reference plane of the joint,
Means for calculating the position and the inclination direction;
Calculate the positional relationship between the reference plane and the above-mentioned insertion body or fitting part
Means and the calculated position and inclination direction of the reference plane
The position of the fitting or the fitting part is determined based on the positional relationship.
Means for calculating the placement and insertion direction, and
Means for removing the insert from the fitting portion,
A work for attaching the insert to the fitting portion
Mounting means and the calculated position of the inserted body or
And controls the above-mentioned insertion member removing means according to the insertion direction.
First control means, and the calculated position of the inserted body or the fitted portion;
Controls the above-mentioned insertion body attachment means according to the placement and insertion direction
The second control means, and the fitting attached to the fitting portion
Means for detecting the height of the insert and inspecting its mounting status;
It is characterized by comprising. These first and second
In the second insertion / removal robot, when the insertion member is configured to be engaged with the fitting portion and attached, the insertion / detachment attaching / removing means is engaged with the fitting portion. It is preferable that the fastening of the insertion member be performed in at least three steps. Further, it is preferable to provide a means for detecting the torque when screwing the fitting body and comparing the detected value with a set value to determine whether the tightening is good or not.
【0025】(6)上記基準面としては、上記嵌挿体ま
たは上記嵌合部の適当な面を利用することができる。基
準面を持つ上記基準部材としては、上記嵌挿体または上
記嵌合部に係合できるものであれば任意の構成のものを
使用できる。 (6) As the reference surface, the fitting body
Alternatively, an appropriate surface of the fitting portion can be used. Group
As the reference member having a reference surface, the above-mentioned insert or upper
Any structure that can engage the fitting part
Can be used.
【0026】[0026]
【作用】嵌挿体あるいは嵌合部が持つ一面を利用し、ま
たは基準面を持つ部材を付設して基準面を設定すると、
その基準面は、嵌挿体あるいは嵌合部と一定の位置関係
にある。また、嵌挿体と嵌合部の間にも一定の位置関係
がある。従って、基準面を検出してその位置および傾斜
方向を算出する一方で、基準面と嵌挿体あるいは基準面
と嵌合部の間の位置関係を算出すれば、嵌挿体または嵌
合部の位置と嵌挿方向を知ることができる。そこで、得
られた嵌挿体または嵌合部の位置および嵌挿方向に適合
するように、嵌挿体取外し手段あるいは嵌挿体取付け手
段を制御すれば、確実に嵌挿体の取付けあるいは取外し
を行なうことができる。When the reference surface is set by using one surface of the insertion body or the fitting portion or by attaching a member having the reference surface,
The reference plane is in a fixed positional relationship with the fitting or the fitting part. Further, there is a certain positional relationship between the fitting body and the fitting part. Therefore, while detecting the reference plane and calculating its position and inclination direction, calculating the positional relationship between the reference plane and the fitting body or the reference surface and the fitting part allows the fitting body or fitting part to be calculated. The position and the insertion direction can be known. Therefore, if the insertion member removing means or the insertion member attaching means is controlled so as to be adapted to the position and the insertion direction of the obtained insertion member or the fitting portion, the attachment or removal of the insertion member can be surely performed. Can do it.
【0027】また、得られた嵌挿体または嵌合部の位置
および嵌挿方向に適合するように、嵌挿体の姿勢を適宜
変化させてから嵌合部に嵌挿するので、嵌挿体の中心軸
と嵌合部の中心軸が常に合致する。このため、嵌挿体の
嵌合部への取付けおよび取外しが正確に行なえ、しか
も、嵌挿体と嵌合部とがネジで噛合する場合であって
も、嵌挿の際に嵌挿体を回転させることにより常に好適
な状態で噛合およびその解除が行なわれ、従って嵌挿体
を所望の締付けトルクで取付けることができる。Further, since the posture of the inserted body is appropriately changed so as to conform to the position and the inserting direction of the obtained inserted body or the fitted portion, the fitted body is inserted into the fitted portion. And the central axis of the fitting part always coincides. For this reason, it is possible to accurately attach and detach the insertion member to and from the engagement portion, and even when the insertion member and the engagement portion are engaged with each other with a screw, the insertion member is inserted at the time of insertion. By rotating, engagement and disengagement are always performed in a suitable state, so that the insertion member can be mounted with a desired tightening torque.
【0028】[0028]
【実施例】以下、この発明の実施例を添付図面に基づい
て詳細に説明する。なお、これによりこの発明が限定さ
れるものではない。図1は、この発明の嵌挿体脱着ロボ
ットをドラム缶のプラグ脱着ロボットとして構成した一
実施例を示す。DESCRIPTION OF THE PREFERRED EMBODIMENTS Embodiments of the present invention will be described below in detail with reference to the accompanying drawings. It should be noted that the present invention is not limited by this. FIG. 1 shows an embodiment in which the insertion / removal robot of the present invention is configured as a plug / removal robot for a drum can.
【0029】(ロボットの構成)プラグ脱着ロボット1
0は、6軸制御の多関節型ロボットで、本体部20とハ
ンド30を備えてなり、ロボット制御部11により制御
される。本体部20は、ベース21の上に取付けられた
第1アーム22と、第1アーム22に接続された第2ア
ーム23を有しており、第2アーム23の先端には手首
部24が取付けてある。手首部24には、ハンド接続部
材25を介してハンド30が取付けてある。(Arrangement of Robot) Plug Removal Robot 1
Reference numeral 0 denotes a six-axis control articulated robot, which includes a main body 20 and a hand 30 and is controlled by a robot controller 11. The main body 20 has a first arm 22 mounted on a base 21 and a second arm 23 connected to the first arm 22. A wrist 24 is mounted on the tip of the second arm 23. It is. A hand 30 is attached to the wrist 24 via a hand connection member 25.
【0030】ベース21より上位の部分は、垂直に設け
た第1軸A1の周りに回転し、第1アーム22とそれよ
り先の部分は、水平に設けた第2軸A2の周りに旋回す
る。第2アーム23とそれより先の部分は、水平に設け
た第3軸A3の周りに旋回する。手首24とそれより先
の部分は、第4軸A4の周りに回転すると共に、第5軸
A5の周りに旋回する。ハンド30は、第6軸A6の周
りに回転する。The upper part of the base 21 rotates around a vertically provided first axis A1, and the first arm 22 and the part above it pivot about a horizontally provided second axis A2. . The second arm 23 and a portion ahead of the second arm 23 pivot about a horizontally provided third axis A3. The wrist 24 and the part before it rotate around the fourth axis A4 and pivot around the fifth axis A5. The hand 30 rotates around the sixth axis A6.
【0031】ハンド30は、図2および図3に詳細に示
すように、ドラム缶70のプラグ装着部72にねじ込ま
れたプラグPを回転させるエアドライバDRと、プラグ
Pを把持する把持器GRを備えている。As shown in detail in FIGS. 2 and 3, the hand 30 includes an air driver DR for rotating the plug P screwed into the plug mounting portion 72 of the drum 70, and a gripper GR for gripping the plug P. ing.
【0032】エアドライバDRと把持器GRは、共に支
持プレート37に固定してある。エアドライバDRは、
本体部を支持プレート37の上方におき、その回転軸4
1を、支持プレート37の孔を通ってその下方に突出さ
せている。把持器GRは、支持プレート37の下位に位
置している。The air driver DR and the gripper GR are both fixed to the support plate 37. The air driver DR
The main body is placed above the support plate 37 and its rotating shaft 4
1 protrudes downward through a hole in the support plate 37. The gripper GR is located below the support plate 37.
【0033】支持プレート37は、後部において、その
上に固定したブラケット36を介してスライダ34に接
続してある。スライダ34は、保持部材32に固定され
た案内バー33に嵌挿してあり、案内バー33に沿って
変位可能である。また、スライダ34は、2個の圧縮バ
ネ35によって上下両側から付勢され、ハンド30に外
力が作用しないときは、案内バー33の中央付近に位置
する。保持部材32は、接続バー31を介してハンド接
続部材25に接続してある。At the rear, the support plate 37 is connected to the slider 34 via a bracket 36 fixed thereon. The slider 34 is inserted into a guide bar 33 fixed to the holding member 32 and is displaceable along the guide bar 33. The slider 34 is urged from both upper and lower sides by two compression springs 35, and is located near the center of the guide bar 33 when no external force acts on the hand 30. The holding member 32 is connected to the hand connection member 25 via the connection bar 31.
【0034】支持プレート37の下方には、複数のボル
ト38とナット39により、支持プレート37の下面と
の間に隙間をあけて可動プレート40が吊り下げ支持し
てある。ボルト38は、支持プレート37のいわゆるバ
カ孔に挿通してあるため、可動プレート40は支持プレ
ート37に対して変位可能である。Below the support plate 37, a movable plate 40 is suspended and supported by a plurality of bolts 38 and nuts 39 with a gap between the support plate 37 and the lower surface of the support plate 37. Since the bolt 38 is inserted through a so-called stupid hole of the support plate 37, the movable plate 40 can be displaced with respect to the support plate 37.
【0035】把持器GRは、可動プレート40に、3個
の把持爪44を下方に向けて固定してある。把持器GR
の制御は、管45を通じて供給される圧縮空気により行
なう。圧縮空気を供給すると、把持器GR内のエアシリ
ンダ(図示省略)が作動し、3個の把持爪44の下端が
内側(または外側)に向かって揺動する。こうして、プ
ラグPを把持することができる。圧縮空気を排出する
と、把持爪44はバネ(図示省略)の弾性力により外側
(または内側)に向かって揺動する。The gripper GR has a movable plate 40 with three gripping claws 44 fixed downward. Gripping device GR
Is controlled by the compressed air supplied through the pipe 45. When the compressed air is supplied, an air cylinder (not shown) in the gripper GR operates, and the lower ends of the three gripping claws 44 swing inward (or outward). Thus, the plug P can be gripped. When the compressed air is discharged, the gripping claws 44 swing outward (or inside) by the elastic force of a spring (not shown).
【0036】把持爪44には、近接スイッチ(図示省
略)が取付けてあり、プラグPの把持を非接触で検出で
きるようにしてある。この近接スイッチにより、プラグ
Pの取外しの際に、充填孔HからプラグPが取り外され
たか否かを確認することができる。A proximity switch (not shown) is attached to the gripping claw 44 so that the gripping of the plug P can be detected in a non-contact manner. With this proximity switch, it is possible to confirm whether or not the plug P has been removed from the filling hole H when removing the plug P.
【0037】把持器GRの内部には、エアドライバDR
の回転軸41の回転を伝達する伝達軸42が設けてあ
る。伝達軸42の上端は、回転軸41に係止され、下端
は、把持器GRの中央を貫通してその下方に突出してい
る。伝達軸42の下端には、プラグPの凹部Paに係合
する係合部材43が取り付けてある。An air driver DR is provided inside the gripper GR.
A transmission shaft 42 for transmitting the rotation of the rotation shaft 41 is provided. The upper end of the transmission shaft 42 is locked to the rotating shaft 41, and the lower end penetrates the center of the gripper GR and projects downward. At the lower end of the transmission shaft 42, an engagement member 43 that engages with the recess Pa of the plug P is attached.
【0038】伝達軸42と回転軸41との係止は、遊び
を持たせて行なうのが好ましい。こうすると、プラグP
との係止の際に多少の位置ずれがあっても、伝達軸42
が変位してそれを吸収し、回転軸41に無理な力が作用
するのを防止することができる。The engagement between the transmission shaft 42 and the rotating shaft 41 is preferably performed with play. Then, plug P
Even if there is a slight displacement at the time of locking with the
Is displaced and absorbed, thereby preventing an excessive force from acting on the rotating shaft 41.
【0039】支持プレート37には、さらに前部上面に
エアシリンダCLが取り付けてある。エアシリンダCL
は、位置センサ50を取付けたセンサ保持部材48、4
9を上下に移動させる。中央のセンサ保持部材48の略
中央には、シリンダロッド47が接続してあり、両端部
には下方に向けてセンサ保持部材49が接続してある。
センサ保持部材48にはさらに、両端において、支持プ
レート37を貫通する2本の案内バー46が取付けてあ
る。案内バー46は、センサ保持部材48、49の上下
移動の際にそれらを案内する。The support plate 37 is further provided with an air cylinder CL on the front upper surface. Air cylinder CL
Are the sensor holding members 48, 4 to which the position sensor 50 is attached.
Move 9 up and down. A cylinder rod 47 is connected to substantially the center of the central sensor holding member 48, and a sensor holding member 49 is connected to both ends in a downward direction.
Further, two guide bars 46 penetrating the support plate 37 are attached to both ends of the sensor holding member 48. The guide bar 46 guides the sensor holding members 48 and 49 when moving them up and down.
【0040】2本のセンサ保持部材49の下端には、そ
れぞれ投光器50aと受光器50bが取り付けてある。
投光器50aと受光器50bは、図示しない光電スイッ
チ、電源およびそれらを接続するリード線51とで位置
センサ50を構成する。投光器50から発せられた光が
物体により遮断され、受光器51の受光する光量が所定
値以下に低下すると、光電スイッチが作動してその位置
を検出する。 位置センサ50から出力される電気信号
は、リード線51を介してロボット制御部11に送られ
る。この位置センサ50は、プラグ装着部72の中心位
置を検出するためのものである。A light emitter 50a and a light receiver 50b are attached to the lower ends of the two sensor holding members 49, respectively.
The light emitter 50a and the light receiver 50b form a position sensor 50 with a photoelectric switch (not shown), a power supply, and a lead wire 51 connecting them. When the light emitted from the light emitter 50 is blocked by the object and the amount of light received by the light receiver 51 falls below a predetermined value, the photoelectric switch is activated to detect the position. The electric signal output from the position sensor 50 is sent to the robot controller 11 via the lead wire 51. The position sensor 50 is for detecting the center position of the plug mounting section 72.
【0041】エアシリンダCLの制御は、ロボット制御
部11により、管52を通じて圧縮空気を給排して行な
う。The control of the air cylinder CL is performed by supplying and discharging compressed air through the pipe 52 by the robot controller 11.
【0042】支持プレート37の側面には、センサ保持
部材53を介して変位センサ54が取り付けてある(図
3参照)。変位センサ54は、下端に設けた投光部から
レーザ光を下方に向けて照射し、物体から反射してくる
レーザ光を投光部に隣接して設けた受光部で受光するこ
とにより、その物体の変位(傾斜)を検出する。変位セ
ンサ54から出力される電気信号は、リード線55を介
してロボット制御部11に送られる。この変位センサ5
4は、プラグPまたはプラグ装着部72の傾斜の向きと
角度を検出するためのものである。A displacement sensor 54 is attached to a side surface of the support plate 37 via a sensor holding member 53 (see FIG. 3). The displacement sensor 54 emits laser light downward from a light projecting unit provided at the lower end, and receives laser light reflected from an object by a light receiving unit provided adjacent to the light projecting unit, thereby obtaining the laser beam. Detect the displacement (tilt) of the object. The electric signal output from the displacement sensor 54 is sent to the robot controller 11 via the lead wire 55. This displacement sensor 5
Reference numeral 4 is for detecting the direction and angle of inclination of the plug P or the plug mounting section 72.
【0043】エアドライバDRは、図4に示す制御回路
により、管56を通じて供給される圧縮空気により制御
される。すなわち、ロボット10の制御部11に設けた
エアドライバ制御装置12は、エアドライバDRの回転
軸41さらには伝達軸42を正転させる電磁バルブMV
1、あるいは回転軸41(伝達軸42)を逆転させる電
磁バルブMV2に制御信号を送る。電磁バルブMV1、
MV2は、この制御信号に応答して流路を開閉し、空気
源SからエアドライバDRに圧縮空気を供給する。The air driver DR is controlled by compressed air supplied through a pipe 56 by a control circuit shown in FIG. That is, the air driver control device 12 provided in the control unit 11 of the robot 10 controls the electromagnetic valve MV for rotating the rotation shaft 41 and the transmission shaft 42 of the air driver DR forward.
1 or a control signal is sent to the electromagnetic valve MV2 that rotates the rotation shaft 41 (transmission shaft 42) in reverse. Solenoid valve MV1,
The MV 2 opens and closes the flow path in response to the control signal, and supplies compressed air from the air source S to the air driver DR.
【0044】エアドライバDRには、回転軸41に作用
するトルクと回転数(回転角)を検知するセンサが設け
てあり、作動中、トルク信号と回転数信号をエアドライ
バ制御装置12に送る。また、トルクに異常が生じる
と、トルク異常信号を送る。The air driver DR is provided with a sensor for detecting the torque acting on the rotating shaft 41 and the rotation speed (rotation angle), and sends a torque signal and a rotation speed signal to the air driver control device 12 during operation. When an abnormality occurs in the torque, a torque abnormality signal is sent.
【0045】トルク信号と回転数信号により、ロボット
10は、プラグPの締付けトルクと回転数を常に監視す
る。また、トルク異常信号が発せられると、直ちに作動
を停止する。The robot 10 constantly monitors the tightening torque and the rotation speed of the plug P based on the torque signal and the rotation speed signal. When the torque abnormality signal is issued, the operation is immediately stopped.
【0046】(基準プレートの構成)図5は、基準面を
形成するための基準プレートの一実施例の断面図であ
る。再生ドラム缶は、天板71が不規則に変形している
ことが多いため、天板71を基準面に利用するのは適当
でない。また、プラグPやプラグ装着部72は小さいた
め、これらの一面を基準面とするのも困難である。そこ
で、別個に基準プレート60を作製し、作業時に基準プ
レート60をプラグPあるいはプラグ装着部72上に載
置するようにしたものである。(Configuration of Reference Plate) FIG. 5 is a sectional view of an embodiment of a reference plate for forming a reference surface. It is not appropriate to use the top plate 71 as a reference surface because the top plate 71 is often irregularly deformed in a reclaimed drum. Further, since the plug P and the plug mounting portion 72 are small, it is difficult to use one of these surfaces as a reference surface. Therefore, the reference plate 60 is separately manufactured, and the reference plate 60 is mounted on the plug P or the plug mounting portion 72 during the operation.
【0047】基準プレート60は、平坦な円板状の本体
部61と、本体部61の下位に配置した円柱状の載置部
62と、本体部61の上位に配置したプラグPとほぼ同
じ形状を持つ把持部63から構成してある。本体部6
1、載置部62および把持部63は、互いに重ね合わせ
られ、それらの中心に挿通したボルト64にワッシャ6
6を介してナット65を螺合することにより、一体化さ
れている。The reference plate 60 has a flat disk-shaped main body portion 61, a columnar mounting portion 62 disposed below the main body portion 61, and substantially the same shape as the plug P disposed above the main body portion 61. It has a gripping portion 63 having. Main unit 6
1. The mounting portion 62 and the grip portion 63 are overlapped with each other, and the washer 6 is attached to a bolt 64 inserted through the center thereof.
6 are integrated by screwing a nut 65 through.
【0048】本体部61の上側が、基準面61aとさ
れ、載置部62の下側は、プラグPまたはプラグ装着部
72に接触する載置面62aとされている。基準面61
aと載置面62aは、互いに平行である。The upper side of the main body 61 is a reference surface 61a, and the lower side of the mounting portion 62 is a mounting surface 62a that contacts the plug P or the plug mounting portion 72. Reference surface 61
a and the mounting surface 62a are parallel to each other.
【0049】本体部61の直径は、プラグPの直径より
も数倍大きくされ、ハンド30の変位センサ54からレ
ーザ光が照射される際に、ハンド30の停止位置にずれ
があってもレーザ光を確実に受けるようにしている。The diameter of the main body 61 is made several times larger than the diameter of the plug P. When the displacement sensor 54 of the hand 30 irradiates the laser beam, even if the stop position of the hand 30 is displaced, the laser beam To make sure you receive it.
【0050】また、載置部62の直径は、本体部61の
直径よりは小さいが、プラグPの直径よりは大きくして
ある。このため、プラグPあるいはプラグ装着部72上
に載置される際に位置ずれがあっても、基準プレート6
0は確実に載置されることができる。The diameter of the mounting portion 62 is smaller than the diameter of the main body 61 but larger than the diameter of the plug P. For this reason, even if there is a displacement when the plug is placed on the plug P or the plug mounting portion 72, the reference plate 6
0 can be reliably mounted.
【0051】なお、対象物に基準面として適当な面があ
る場合には、基準プレート60を使用せずに、その面を
利用することも可能である。When the object has a suitable surface as a reference surface, the surface can be used without using the reference plate 60.
【0052】(ロボットの動作)次に、以上の構成とし
たプラグ脱着ロボット10の動作について説明する。図
6は、ドラム缶70のプラグ装着部72に取付けられた
プラグPを取外す場合の手順を示すフローチャートであ
る。(Operation of Robot) Next, the operation of the plug detachable robot 10 having the above configuration will be described. FIG. 6 is a flowchart showing a procedure for removing the plug P attached to the plug attachment section 72 of the drum 70.
【0053】ドラム缶70は、天板71を上に向けて図
示しないコンベアにより順に搬送され、プラグ脱着ロボ
ット10の作動範囲内の所定位置で停止する。このとき
充填孔Hが所定範囲内に位置するように、ドラム缶70
をその中心軸の周りに適宜回動させ、その向きを調整す
る。The drum 70 is conveyed in order by a conveyor (not shown) with the top plate 71 facing upward, and stops at a predetermined position within the operating range of the plug removal robot 10. At this time, the drum 70 is set so that the filling hole H is located within a predetermined range.
Is appropriately rotated around its central axis to adjust its direction.
【0054】基準プレート60は、把持部63を上方に
向けて図示しないプレート台に載置してある。The reference plate 60 is placed on a plate base (not shown) with the grip 63 facing upward.
【0055】プラグ脱着ロボット10は、まず、ハンド
30を待機位置からプレート台まで移動し、把持爪44
により基準プレート60の把持部63を把持する。次
に、ハンド30をドラム缶70の上方まで移動し、基準
プレート60をプラグ装着部72に取付けられたプラグ
P上に載置する。こうして、プラグPに基準面61aが
形成される(ステップS1)。First, the plug removing robot 10 moves the hand 30 from the standby position to the plate base, and
Grips the grip portion 63 of the reference plate 60. Next, the hand 30 is moved to above the drum 70, and the reference plate 60 is placed on the plug P attached to the plug attachment section 72. Thus, the reference surface 61a is formed on the plug P (Step S1).
【0056】基準プレート60を載置した後、ハンド3
0は基準プレート60の上方の所定位置で待機する。After placing the reference plate 60, the hand 3
0 stands by at a predetermined position above the reference plate 60.
【0057】可動プレート40は、支持プレート37に
対して変位可能としてあるため、把持爪44で基準プレ
ート60やプラグPを把持する際に、把持器GRの中心
と基準プレート60あるいはプラグPの中心がずれてい
ても、可動プレート40が変位してそのズレを吸収し、
それらの把持を適切に行なうことができる。また、支持
プレート37が、案内バー33に沿って変位可能である
ため、案内バー33に沿う方向に位置ずれがあっても、
把持爪44などが破損する恐れがない。Since the movable plate 40 can be displaced with respect to the support plate 37, when the gripper 44 grips the reference plate 60 or the plug P, the center of the gripper GR and the center of the reference plate 60 or the plug P are moved. The movable plate 40 is displaced and absorbs the deviation,
They can be properly held. Further, since the support plate 37 can be displaced along the guide bar 33, even if there is a displacement in the direction along the guide bar 33,
There is no possibility that the gripping claws 44 and the like are damaged.
【0058】プラグ脱着ロボット10は、次に、以下の
ようにして、基準面61aを検出してその上の3点の高
さを算出する(ステップS2)。まず、ハンド30を移
動してそれに取り付けた変位センサ54を基準プレート
60の真上の所定位置に静止させる。次に、図8(b)
に示すように、変位センサ54から真下に向けてレーザ
光を投光し、基準面61a上の点Oに照射する。次に、
ハンド30を水平方向に移動させ、図8(a)に示す基
準面61a上の点Xに同様にしてレーザ光を照射する。
さらに、ハンド30を水平方向に移動させ、図8(a)
に示す基準面61a上の点Yにレーザ光を照射する。な
お、投光時に静止する変位センサ54の位置(それぞれ
点O、X、Yの真上にある)は、ロボット10に予め教
示しておく。Next, the plug attaching / detaching robot 10 detects the reference surface 61a and calculates the heights of three points above the reference surface 61a as follows (step S2). First, the hand 30 is moved and the displacement sensor 54 attached thereto is stopped at a predetermined position just above the reference plate 60. Next, FIG.
As shown in (1), a laser beam is projected from directly below the displacement sensor 54 to irradiate a point O on the reference surface 61a. next,
The hand 30 is moved in the horizontal direction, and the point X on the reference plane 61a shown in FIG.
Further, the hand 30 is moved in the horizontal direction, and FIG.
Is irradiated with a laser beam on a point Y on the reference surface 61a shown in FIG. The position of the displacement sensor 54 that stops at the time of light projection (directly above the points O, X, and Y, respectively) is taught to the robot 10 in advance.
【0059】図8(b)に示すように、基準面61aが
傾斜している場合、反射光は照射光からずれる。変位セ
ンサ54は、この反射光の変位を検出し、基準面61a
が傾斜していることを認識する。基準面61aが傾斜し
ていない場合は、反射光は照射光と重なるため、変位セ
ンサ54は、基準面61aが傾斜していないことを認識
する。As shown in FIG. 8B, when the reference surface 61a is inclined, the reflected light deviates from the irradiation light. The displacement sensor 54 detects the displacement of the reflected light, and outputs the reference surface 61a
Recognize that is inclined. If the reference surface 61a is not inclined, the reflected light overlaps with the irradiation light, and the displacement sensor 54 recognizes that the reference surface 61a is not inclined.
【0060】ハンド30の上記移動により、変位センサ
54は、基準面61a上の点O、X、Yにおける反射光
の変位量を検出する。点O、X、Yにレーザ光を投光す
る時の変位センサ54の高さは同じであり、また点O、
X、Yにおける反射光の反射角は同じであるが、点O、
X、Yの高さが異なるため、各点で変位センサ54が検
出する変位量は異なる。そこで、得られた3点での変位
量データを使用して、3点O、X、Yの相対高さ(高さ
の差)を算出する。With the movement of the hand 30, the displacement sensor 54 detects the amount of displacement of the reflected light at the points O, X, and Y on the reference surface 61a. The height of the displacement sensor 54 when projecting a laser beam to the points O, X, and Y is the same.
The reflection angles of the reflected light in X and Y are the same, but the points O and
Since the heights of X and Y are different, the displacement amount detected by the displacement sensor 54 at each point is different. Therefore, using the obtained displacement data at the three points, the relative heights (differences in height) of the three points O, X, and Y are calculated.
【0061】なお、3点O、X、Yにおける相対高さの
代わりに、3点O、X、Yにおけるセンサとの相対距離
を検出するようにしてもよい。Instead of the relative heights at the three points O, X, and Y, the relative distances from the sensors at the three points O, X, and Y may be detected.
【0062】次のステップでは、得られた3点O、X、
Yでの相対高さから、以下のようにして、基準面61a
の傾斜方向すなわち傾斜の向きと傾斜角を算出する(ス
テップS3)。まず、得られた相対高さから、3点O、
X、Yを通過する平面を算出する。算出された平面は基
準面61aと平行であり、同じ傾斜角を持つ。そこで、
算出された平面の傾斜の向きと傾斜角を算出すれば、そ
れらは、基準面61aの傾斜の向きと傾斜角に一致す
る。In the next step, the obtained three points O, X,
From the relative height at Y, the reference surface 61a
Is calculated, that is, the inclination direction and the inclination angle (step S3). First, from the obtained relative height, three points O,
A plane passing through X and Y is calculated. The calculated plane is parallel to the reference plane 61a and has the same inclination angle. Therefore,
When the calculated inclination direction and inclination angle of the plane are calculated, they match the inclination direction and the inclination angle of the reference plane 61a.
【0063】以上のステップが完了すると、基準プレー
ト60は不要となる。そこで、ハンド30を下降して把
持爪44によりプラグP上の基準プレート60を把持
し、プレート台に戻す(ステップS4)。When the above steps are completed, the reference plate 60 becomes unnecessary. Then, the hand 30 is lowered and the reference plate 60 on the plug P is gripped by the gripping claws 44 and returned to the plate base (step S4).
【0064】基準プレート60をプレート台に戻した
後、ハンド30は再びドラム缶70の方向に移動し、プ
ラグ装着部72の上方の所定位置に停止する。After returning the reference plate 60 to the plate base, the hand 30 moves again toward the drum 70 and stops at a predetermined position above the plug mounting portion 72.
【0065】次のステップS5では、次のようにして、
プラグ装着部72の位置を2点で検出する。まず、ハン
ド30に取付けたエアシリンダCLを作動して位置セン
サ50を下降させ(図3参照)、プラグ装着部72の近
傍に設定した基準位置に位置させる。この基準位置は、
位置センサ50をそこから水平方向に移動させると、投
光器50aと受光器50bを結ぶ直線がプラグ装着部7
2と交差する高さに設定してある(図9(b)参照)。In the next step S5, as follows:
The position of the plug mounting section 72 is detected at two points. First, the air cylinder CL attached to the hand 30 is actuated to lower the position sensor 50 (see FIG. 3) and to position the position sensor 50 at a reference position set near the plug mounting section 72. This reference position is
When the position sensor 50 is moved horizontally therefrom, a straight line connecting the light emitter 50a and the light receiver 50b becomes
The height is set to intersect with 2 (see FIG. 9B).
【0066】次に、図9(a)に示すように、上記基準
位置から水平に矢印aの方向にハンド30を移動させ
る。そして、移動中に受光器50bの受光量が大きく低
下する位置を検出する。こうして、プラグ装着部72の
端縁の位置Aを検出する。Next, as shown in FIG. 9A, the hand 30 is moved horizontally from the reference position in the direction of arrow a. Then, a position where the amount of light received by the light receiver 50b is significantly reduced during movement is detected. Thus, the position A of the edge of the plug mounting section 72 is detected.
【0067】次に、移動方向を変え、上記基準位置から
水平に矢印bの方向(矢印aの方向に直交する)にハン
ド30を移動させ、プラグ装着部72の端縁の位置Bを
検知する。Next, the moving direction is changed, the hand 30 is moved horizontally from the reference position in the direction of arrow b (perpendicular to the direction of arrow a), and the position B of the edge of the plug mounting portion 72 is detected. .
【0068】こうして、プラグ装着部72の端縁の基準
位置に対する相対位置を2点A、Bで検出すると、これ
らの位置データと、ステップS3で算出した基準面61
aの傾斜方向データを利用して、プラグ装着部72に取
付けられたプラグPの中心位置と嵌挿方向を算出する
(ステップS6)。When the relative positions of the edge of the plug mounting portion 72 with respect to the reference position are detected at two points A and B, the position data and the reference surface 61 calculated in step S3 are obtained.
The center position and the insertion direction of the plug P attached to the plug attachment portion 72 are calculated using the inclination direction data a (step S6).
【0069】プラグPの中心位置は、プラグ装着部72
の2点A、Bにおける相対位置データから算出する。す
なわち、これらの相対位置データから、プラグ装着部7
2の端縁の2点A、Bにおける位置座標を算出し、算出
した位置座標と、予め記憶されているプラグ装着部72
の直径データを用いて、水平面内の一つの円を特定す
る。この円は、プラグ装着部72の水平断面の輪郭を表
わす円である。従って、その円の中心の座標を算出すれ
ば、それがプラグ装着部72の上記水平面内における中
心の座標となる。The center position of the plug P is
From the relative position data at the two points A and B. That is, from these relative position data, the plug mounting section 7
The position coordinates at two points A and B at the edge of the position No. 2 are calculated, and the calculated position coordinates and the plug mounting portion 72 stored in advance.
One circle in the horizontal plane is specified using the diameter data of This circle is a circle representing the outline of the horizontal cross section of the plug mounting section 72. Therefore, if the coordinates of the center of the circle are calculated, it becomes the coordinates of the center of the plug mounting portion 72 in the horizontal plane.
【0070】充填孔Hは、プラグ装着部72とほぼ同心
に形成されているので、プラグPの中心位置はプラグ装
着部72の中心位置とほぼ一致する。そこで、上記円の
中心座標を、プラグ装着部72内にあるプラグPの上記
水平面内における中心位置座標とすればよい。Since the filling hole H is formed substantially concentrically with the plug mounting portion 72, the center position of the plug P substantially coincides with the center position of the plug mounting portion 72. Therefore, the center coordinates of the circle may be set as the center position coordinates of the plug P in the plug mounting section 72 in the horizontal plane.
【0071】プラグPの嵌挿方向は、基準面61aとプ
ラグPの間の位置関係と、基準面61aの傾斜方向デー
タから算出する。すなわち、基準面61aはプラグPの
上面と平行であり、またプラグPの嵌挿方向(ねじ込み
方向)はその上面に対してほぼ直角をなす。そこで、基
準面61aに直交する方向をプラグPの嵌挿方向とす
る。The insertion direction of the plug P is calculated from the positional relationship between the reference surface 61a and the plug P and the inclination direction data of the reference surface 61a. That is, the reference surface 61a is parallel to the upper surface of the plug P, and the insertion direction (screw-in direction) of the plug P is substantially perpendicular to the upper surface. Therefore, a direction perpendicular to the reference surface 61a is defined as a direction in which the plug P is inserted.
【0072】次のステップS7では、まず、得られたプ
ラグPの嵌挿方向に合わせてハンド30の姿勢を制御
し、エアドライバDRの回転軸41をプラグPの嵌挿方
向に一致させる。そして、得られたプラグPの中心位置
に向かって移動して係合部材43をプラグPの凹部Pa
に係合させ、回転軸41を回転させてプラグPの噛合を
解除する。その間、把持器GRの把持爪44は、邪魔に
ならないように外側に開いた状態に保たれる。そこで、
把持爪44を閉じてプラグPを把持した後、持ち上げて
プラグPをプラグ装着部72から取外す。In the next step S7, first, the attitude of the hand 30 is controlled in accordance with the obtained insertion direction of the plug P, and the rotation shaft 41 of the air driver DR is made to coincide with the insertion direction of the plug P. Then, the plug P is moved toward the center position of the obtained plug P, and the engaging member 43 is moved to the concave portion Pa of the plug P.
And the rotation shaft 41 is rotated to release the engagement of the plug P. Meanwhile, the gripping claws 44 of the gripper GR are kept open outward so as not to interfere. Therefore,
After the gripping claws 44 are closed and the plug P is gripped, the plug P is lifted and removed from the plug mounting portion 72.
【0073】エアドライバDRは、その回転軸41が、
係合部材43をプラグPに係合させる直前に緩め方向に
回転を始めるように制御される。こうすることにより、
係合部材43を、プラグPの係止用突起Pbに適切に係
止させることができる。そして、係合部材43が係止用
突起Pbに係止すると、回転はいったん停止され、その
後、プラグPの噛合を解除するために再び緩め方向に回
転される。The rotation axis 41 of the air driver DR is
It is controlled so as to start rotating in the loosening direction immediately before the engagement member 43 is engaged with the plug P. By doing this,
The engagement member 43 can be appropriately locked to the locking projection Pb of the plug P. When the engagement member 43 is locked to the locking projection Pb, the rotation is stopped once, and then the plug P is rotated again in the loosening direction to release the engagement of the plug P.
【0074】エアドライバDRが作動している間に、エ
アドライバDRに設けたセンサが回転トルクの異常を検
知すると、直ちにエアドライバDRの作動を停止すると
共に、ハンド30を待機位置に移動して装缶作業を中止
する。When a sensor provided on the air driver DR detects an abnormal rotation torque while the air driver DR is operating, the operation of the air driver DR is immediately stopped, and the hand 30 is moved to the standby position. Cancel canning work.
【0075】次のステップS8では、変位センサ54に
より、プラグ装着部72からプラグPが取外されている
か否かを確認する。取外されていないと判断した場合
は、ステップS7に戻り、もう一度プラグPの取外し作
業を行なう。取外されていると判断した場合は、次のス
テップS9に進む。In the next step S8, it is confirmed by the displacement sensor 54 whether or not the plug P has been removed from the plug mounting portion 72. If it is determined that the plug P has not been removed, the process returns to step S7, and the plug P is removed again. If it is determined that it has been removed, the process proceeds to the next step S9.
【0076】ステップS8の検査は、図10に示すよう
に、変位センサ54を充填孔Hの上方の所定位置(充填
孔Hの中心の上方が好ましい)に停止させ、そこで下方
に向けてレーザ光を照射して行なう。プラグ装着部72
にプラグPが残っていると、レーザ光はプラグPの上面
により反射されるため、変位センサ54は、ステップS
2で基準面61a上の点O、X、Yの高さを検出した時
とほぼ同じ変位量を検出する(図10(b)参照)。し
かし、プラグPが残っていないと、レーザ光を受光でき
ないか、受光しても変位量が異なる(図10(a)参
照)。そこで、受光の有無および変位量の違いによっ
て、プラグPの有無を検査する。In the inspection in step S8, as shown in FIG. 10, the displacement sensor 54 is stopped at a predetermined position above the filling hole H (preferably above the center of the filling hole H), and the laser beam is directed downward therefrom. Irradiation. Plug mounting part 72
If the plug P remains in the position, since the laser light is reflected by the upper surface of the plug P, the displacement sensor 54
Approximately the same amount of displacement as when the heights of the points O, X, and Y on the reference plane 61a are detected in step 2 is detected (see FIG. 10B). However, if the plug P does not remain, the laser beam cannot be received, or the amount of displacement differs even if the laser beam is received (see FIG. 10A). Therefore, the presence or absence of the plug P is inspected based on the presence or absence of light reception and the difference in the amount of displacement.
【0077】なお、把持爪44がプラグPを適切に把持
したか否かを、把持爪44に取付けた近接スイッチによ
り検知できるので、変位センサ54によるプラグPの有
無の検査と相まって、プラグ取外し作業の信頼性が高く
なる。Since the proximity switch attached to the gripping claw 44 can detect whether the gripping claw 44 has properly gripped the plug P, the plug removal work can be performed in conjunction with the inspection of the presence or absence of the plug P by the displacement sensor 54. Reliability is increased.
【0078】ステップS9では、ハンド30が、プラグ
装着部72から取外したプラグPをプラグ台まで移動し
てその上に載置する。ステップS10では、プラグPを
プラグ台に載置したハンド30が、待機位置に移動し、
次のプラグ取付け作業を待つ。以上のステップS1〜S
10を経て、プラグ取外し作業は完了する。In step S9, the hand 30 moves the plug P removed from the plug mounting section 72 to the plug base and places it on it. In step S10, the hand 30 with the plug P placed on the plug base moves to the standby position,
Wait for the next plug installation. The above steps S1 to S
After 10, the plug removal operation is completed.
【0079】そこで、収容物のドラム缶70への充填作
業が行なわれる。充填が完了すると、図7に示す手順で
プラグPの取付けを行なう。Then, the operation of filling the drums 70 with the contents is performed. When the filling is completed, the plug P is attached according to the procedure shown in FIG.
【0080】ステップS21では、待機位置にあるハン
ド30が、プレート台上の基準プレート60を取りに行
き、充填完了したドラム缶70のプラグ装着部72の上
面に載置する。これで、プラグ装着部72に基準面61
aが形成される。In step S21, the hand 30 at the standby position goes to pick up the reference plate 60 on the plate base and places it on the upper surface of the plug mounting section 72 of the drum 70 that has been filled. As a result, the reference surface 61 is
a is formed.
【0081】ステップS22では、変位センサ54によ
り、ステップS2と同様にして基準面61a上の3点
O、X、Yの高さを算出する。In step S22, the heights of the three points O, X, and Y on the reference surface 61a are calculated by the displacement sensor 54 in the same manner as in step S2.
【0082】ステップS23では、得られた基準面61
a上の3点O、X、Yの位置データから、ステップS3
と同様にして基準面61aの傾斜方向を算出する。In step S23, the obtained reference surface 61
From the position data of the three points O, X, and Y on
Similarly, the inclination direction of the reference plane 61a is calculated.
【0083】ステップS24では、ステップS4と同様
にして、プラグ装着部72上の基準プレート60をプレ
ート台に戻す。その後、ハンド30はドラム缶70の上
方の所定位置に停止する。In step S24, similarly to step S4, the reference plate 60 on the plug mounting section 72 is returned to the plate base. Thereafter, the hand 30 stops at a predetermined position above the drum 70.
【0084】ステップS25では、ステップS5と同様
にして、位置センサ50を用いてプラグ装着部72の位
置を2点A、Bで検出する。In step S25, the position of the plug mounting portion 72 is detected at two points A and B using the position sensor 50 in the same manner as in step S5.
【0085】ステップS26では、得られたプラグ装着
部72の位置データに基づいて、ステップS6と同様に
して、充填孔Hの中心位置と嵌挿方向を算出する。すな
わち、基準面61aはプラグ装着部72の上面と平行で
あり、またプラグ装着部72の嵌挿方向はその上面に対
してほぼ直角をなすので、基準面61aに直交する方向
を充填孔Hの嵌挿方向とする。充填孔Hの中心位置は、
プラグ装着部72の相対位置データから算出した2点の
位置座標と、プラグ装着部72の直径データを用いて、
水平面内で一つの円を特定し、その円の中心の座標をプ
ラグ装着部72の中心の座標とする。In step S26, the center position and the insertion direction of the filling hole H are calculated based on the obtained position data of the plug mounting section 72 in the same manner as in step S6. That is, the reference surface 61a is parallel to the upper surface of the plug mounting portion 72, and the insertion direction of the plug mounting portion 72 is substantially perpendicular to the upper surface. The direction is the insertion direction. The center position of the filling hole H is
Using the position coordinates of two points calculated from the relative position data of the plug mounting section 72 and the diameter data of the plug mounting section 72,
One circle is specified in the horizontal plane, and the coordinates of the center of the circle are set as the coordinates of the center of the plug mounting section 72.
【0086】以上のステップS21〜S26は、ドラム
缶70に収容物を充填すると、収容物の重量等により、
充填孔Hの中心位置や嵌挿方向が充填前に比べてずれる
恐れがあることを考慮し、再確認する意味で行なうもの
である。従って、その恐れがほとんどない場合には、ス
テップS21〜S26を省略し、次のステップS27か
ら開始してよい。[0086] The above steps S21 to S26 are performed when the drum 70 is filled with the contents, depending on the weight of the contents and the like.
In consideration of the possibility that the center position and the insertion direction of the filling hole H may be shifted as compared with those before filling, this is performed in a sense of reconfirmation. Therefore, when there is almost no fear of this, steps S21 to S26 may be omitted and the process may be started from the next step S27.
【0087】ステップS27では、ドラム缶70の上方
に位置していたハンド30が、プラグ台まで移動し、そ
こに載置していたプラグPを把持爪44で把持する。In step S 27, the hand 30 located above the drum 70 moves to the plug stand, and holds the plug P placed thereon with the holding claws 44.
【0088】ステップS28では、ステップS7と同様
に、回転軸41が算出した嵌挿方向に沿うと共に回転軸
41の先端が算出した中心位置に向かうようにハンド3
0の姿勢を制御し、把持したプラグPを充填孔Hに向か
って移動させる。そして、プラグPをプラグ装着部72
の上面に着座させた後、把持爪44を開放する。そこ
で、係合部材43をプラグPの凹部Paに係合させると
共に、エアドライバDRを作動させ、プラグ装着部72
にプラグPを噛合させると共に所定のトルクで締付け
る。In step S28, as in step S7, the hand 3 is moved so that the rotating shaft 41 follows the calculated insertion direction and the tip of the rotating shaft 41 is directed to the calculated center position.
The posture of the plug P is controlled to zero, and the gripped plug P is moved toward the filling hole H. Then, the plug P is connected to the plug mounting portion 72.
After being seated on the upper surface of the gripper, the gripping claws 44 are released. Then, the engaging member 43 is engaged with the concave portion Pa of the plug P, and the air driver DR is operated, so that the plug mounting portion 72 is
And tighten with a predetermined torque.
【0089】このときのエアドライバDRの動作は、図
12に示す通りである。すなわち、プラグPがプラグ装
着部72の上面に着座すると、最初の「噛合調整モー
ド」では、エアドライバDRの回転軸41を緩め方向に
回転させる(時刻t0〜t1)。これは、次の「仮締め
モード」において、プラグPの雄ネジとプラグ装着部7
2の雌ネジの噛合を適切且つ確実に行なうために行なう
ものである。それは、プラグPは、通常のボルトに比べ
ると大口径(例えば約60mm)であり、しかもプラグ
Pの雄ネジとプラグ装着部72の雌ネジがいずれも平行
ネジであるため、プラグPをプラグ装着部72に着座さ
せてから直ちに締付け方向に回転させると、回転軸41
(伝達軸42)の方向とプラグPの嵌挿方向が合致して
いても、プラグPの雄ネジとプラグ装着部72の雌ネジ
がうまく噛合しない恐れが大きいからである。回転軸4
1は、所定時間回転するといったん停止させる。この回
転時間の制御は、ロボット制御部11に設けたタイマで
行なう。The operation of the air driver DR at this time is as shown in FIG. That is, when the plug P is seated on the upper surface of the plug mounting portion 72, in the first “meshing adjustment mode”, the rotating shaft 41 of the air driver DR is rotated in the loosening direction (time t0 to t1). This is because, in the next “temporary tightening mode”, the male screw of the plug P and the plug mounting portion 7
This is performed in order to properly and surely engage the second female screw. This is because the plug P has a large diameter (for example, about 60 mm) as compared with a normal bolt, and the male screw of the plug P and the female screw of the plug mounting portion 72 are both parallel screws. When it is immediately rotated in the tightening direction after being seated on the portion 72, the rotating shaft 41
This is because even if the direction of the (transmission shaft 42) and the insertion direction of the plug P coincide with each other, there is a great possibility that the male screw of the plug P and the female screw of the plug mounting portion 72 do not mesh well. Rotary axis 4
1 stops as soon as it rotates for a predetermined time. The rotation time is controlled by a timer provided in the robot controller 11.
【0090】次の「仮締めモード」では、回転方向を反
転させ、回転軸41を締付け方向に回転させてプラグP
の噛合と締付けを行なう(時刻t2〜t3)。その回転
は、締付けトルクが所定の仮締めトルク値になるまで行
なう。こうしてプラグPの仮締めを行なった後、回転軸
41をいったん停止させる。In the next “temporary tightening mode”, the rotation direction is reversed, and the rotating shaft 41 is rotated in the tightening direction, so that the plug P
Is engaged and tightened (time t2 to t3). The rotation is performed until the tightening torque reaches a predetermined temporary tightening torque value. After the plug P is temporarily tightened in this way, the rotating shaft 41 is temporarily stopped.
【0091】次の「本締めモード」では、再び、回転軸
41を締付け方向に回転させてプラグPの本締めを行な
う(時刻t4〜t5)。その回転は、締付けトルクが所
定の本締めトルク値(仮締めトルク値より高い)になる
まで行なわれる。本締め終了後、回転軸41をいったん
停止させる。In the next "final tightening mode", the rotary shaft 41 is again rotated in the tightening direction to perform the final tightening of the plug P (time t4 to t5). The rotation is performed until the tightening torque reaches a predetermined final tightening torque value (higher than the temporary tightening torque value). After the final tightening, the rotation shaft 41 is temporarily stopped.
【0092】最後の「増締めモード」では、回転軸41
をさらに締付け方向に回転させてプラグPの増締めを行
なう(時刻t6〜t7)。その回転は、締付けトルクが
所定の増締めトルク値になるまで行なわれる。こうし
て、プラグPを仮締め、本締め、増締めの3段階を経て
締付け、プラグPの取付けを終了する。In the last “retightening mode”, the rotating shaft 41
Is further rotated in the tightening direction to retighten the plug P (time t6 to t7). The rotation is performed until the tightening torque reaches a predetermined tightening torque value. In this way, the plug P is tightened through three stages of temporary tightening, final tightening, and additional tightening, and the mounting of the plug P is completed.
【0093】このように、プラグPの締付けを設定トル
ク値の異なる3モードで行なうので、プラグPの締付け
が確実に行なわれると共に、締付けトルクもほぼ一定に
保たれる。As described above, since the plug P is tightened in the three modes having different set torque values, the plug P is securely tightened, and the tightening torque is kept substantially constant.
【0094】締付けを行なっている間、プラグPの締付
けトルクは、例えば図13に示すように変化する。「仮
締めモード」では、仮締めの当初にネジの噛合により第
1のピーク(a点)が形成され、その最後に締付けによ
り第2のピーク(b点)が形成される。第2のピーク
は、予め設定された仮締めトルク値を示す。During the tightening, the tightening torque of the plug P changes, for example, as shown in FIG. In the “temporary tightening mode”, a first peak (point a) is formed by the engagement of the screws at the beginning of the temporary tightening, and a second peak (point b) is formed by final tightening. The second peak indicates a preset temporary tightening torque value.
【0095】仮締めが終了すると、その締付けトルク値
は少し低下する。そこで、「本締めモード」では、その
最初の締付けトルク値は、第2のピーク(b点)よりも
低い値(点c)にある。本締めにより、締付けトルク値
は急激に上昇し、第3のピーク(点d)を形成する。第
3のピークは、予め設定された本締めトルク値を示す。When the temporary tightening is completed, the tightening torque value slightly decreases. Therefore, in the "final fastening mode", the initial fastening torque value is at a value (point c) lower than the second peak (point b). By the final tightening, the tightening torque value sharply rises and forms a third peak (point d). The third peak indicates a preset final tightening torque value.
【0096】本締めが終了すると、その締付けトルク値
は少し低下する。そこで、「増締めモード」では、その
最初の締付けトルク値は、第3のピーク(d点)よりも
低い値(点e)にある。増締めにより、締付けトルク値
はさらに上昇し、第4のピーク(点f)を形成する。第
4のピークは、予め設定された増締めトルク値を示す。When the final tightening is completed, the tightening torque value slightly decreases. Therefore, in the "increase tightening mode", the initial tightening torque value is at a value (point e) lower than the third peak (d point). With the additional tightening, the tightening torque value further increases and forms a fourth peak (point f). The fourth peak indicates a preset tightening torque value.
【0097】このロボット10では、エアドライバDR
に取り付けたセンサにより、仮締め、本締め、増締めの
各モード毎にトルク、回転数、および回転時間を検知
し、検知した値が予め設定した範囲内にあるか否かを監
視している。そして、いずれかのモードで、トルク、回
転数または回転時間のいずれかについて予め設定した範
囲外の値を検知したときは、直ちに作動を停止する。従
って、すべてのドラム缶70について締付けトルク、回
転数等の管理を行なうことができるので、プラグPの締
付け不良に起因するドラム缶70の損傷や収容物の品質
低下等を確実に防止することができ、プラグ締付け作業
の信頼性が非常に高くなる。In this robot 10, the air driver DR
The sensor attached to detects the torque, rotation speed, and rotation time for each of the temporary tightening, final tightening, and additional tightening modes, and monitors whether the detected values are within a preset range. . In any one of the modes, when a value outside the preset range is detected for any of the torque, the number of rotations, and the rotation time, the operation is immediately stopped. Therefore, since the tightening torque, the number of rotations, and the like can be controlled for all the drums 70, damage to the drums 70 due to poor tightening of the plug P and a decrease in the quality of the contents can be reliably prevented. The reliability of the plug tightening operation becomes very high.
【0098】ステップS29では、ステップS8(図1
0参照)と同様にして、プラグPがプラグ装着部72に
取付けられているか否かを検査する。プラグPがないと
判断した場合は、ハンド30が予備プラグを取りに行
き、それを把持する(ステップS30)。そして、ステ
ップS28に飛び、プラグ取付け作業をやり直す。プラ
グPがあると判断した場合は、ステップS31に進む。In step S29, step S8 (FIG. 1)
0), it is checked whether or not the plug P is attached to the plug mounting portion 72. If it is determined that there is no plug P, the hand 30 goes to get a spare plug and grips it (step S30). Then, the process jumps to step S28 to repeat the plug attaching operation. If it is determined that there is a plug P, the process proceeds to step S31.
【0099】ステップS31では、位置センサ50によ
り、プラグPの締付け状況が良好か否かを判断する。締
付け状況が良好でないと判断されると、ハンド30が移
動して係合部材43を再びプラグPの凹部Paに係合さ
せ、エアドライバDRを逆転させてプラグPを取り外す
(ステップS32)。次に、取り外したプラグPを把持
爪44により把持してプラグ台まで移動し、その上に載
置する(ステップS33)。そしてステップS21に飛
び、ステップS21〜S28をやり直す。In step S31, the position sensor 50 determines whether or not the tightening condition of the plug P is good. If it is determined that the tightening condition is not good, the hand 30 moves to engage the engaging member 43 again with the concave portion Pa of the plug P, and the air driver DR is reversed to remove the plug P (Step S32). Next, the detached plug P is gripped by the gripping claws 44, moved to the plug base, and placed thereon (step S33). Then, the process jumps to step S21 and repeats steps S21 to S28.
【0100】締付け状況が良好と判断されると、ステッ
プS34に進み、ハンド30を待機位置へ移動して作業
を終了する。そして、次のドラム缶70に対する作業の
ために待機する。If it is determined that the tightening state is good, the process proceeds to step S34, where the hand 30 is moved to the standby position and the operation is completed. Then, it waits for the operation for the next drum 70.
【0101】ステップS31のプラグ締付け状況の判断
は、図11に示すようにして行なう。まず、ハンド30
をプラグPの上方の所定位置に停止させた後、シリンダ
CLを作動させて位置センサ50を下降させる。その位
置は、投光部50aと受光部50bの間にプラグ装着部
72が位置し、且つ、投光部50aから投光される光線
が、正常にねじ込まれたプラグPの直径に沿ってその上
面近傍を通過するように設定してある。次に、投光部5
0aから受光部50bに向けて投光し、光が遮断される
か否かを検査する。The determination of the plug tightening state in step S31 is performed as shown in FIG. First, hand 30
Is stopped at a predetermined position above the plug P, and then the position sensor 50 is lowered by operating the cylinder CL. The position is such that the plug mounting portion 72 is located between the light projecting portion 50a and the light receiving portion 50b, and the light beam emitted from the light projecting portion 50a is moved along the diameter of the normally screwed plug P. It is set to pass near the upper surface. Next, the light emitting unit 5
The light is projected from 0a toward the light receiving unit 50b to check whether or not the light is blocked.
【0102】プラグPが正常にねじ込まれていれば、図
11(a)(b)のように、光はまったく遮断されな
い。しかし、正常にねじ込まれていないときは、図11
(c)(d)(e)のように、光が遮断され、受光量が
ゼロとなるか減少する。そこで、受光量を検出すること
により、プラグPの締付け状況の良否を判断することが
できる。図11(c)(e)はプラグPの噛合が適切で
ない場合を、図11(d)は増締めが不良の場合を示
す。If the plug P is screwed normally, no light is blocked as shown in FIGS. 11 (a) and 11 (b). However, when it is not screwed properly, FIG.
(C) As shown in (d) and (e), the light is blocked, and the amount of received light becomes zero or decreases. Therefore, by detecting the amount of received light, it is possible to determine whether the plug P is properly tightened. FIGS. 11C and 11E show a case where the plug P is not properly engaged, and FIG. 11D shows a case where the retightening is poor.
【0103】なお、位置センサ50を配置する位置は、
算出したプラグPの嵌挿方向に応じて調整され、投光部
50aから受光部50bに向けて投光される光線が、プ
ラグP上面と平行になるように設定される。従って、プ
ラグPの傾斜角が大きくても、光線はプラグP上面と必
ず平行になるので、判断を誤る恐れはない。The position where the position sensor 50 is arranged is
Adjusted according to the calculated insertion direction of the plug P, the light beam emitted from the light projecting unit 50a toward the light receiving unit 50b is set to be parallel to the upper surface of the plug P. Therefore, even if the inclination angle of the plug P is large, the light beam is always parallel to the upper surface of the plug P, and there is no risk of making a mistake in the determination.
【0104】上記実施例では、プラグPの締付けを少な
くとも3段階に分けて行なうので、所望の締付けトルク
を高い信頼性をもって得ることができる。従って、位置
のずれや姿勢の変動が大きく、且つ、プラグPの中心軸
とプラグ装着部の中心軸が合致していないと適切な噛合
やその解除が期待し難い再生ドラム缶70のプラグ装着
部72に対して、プラグPの取外しおよび取付け作業を
無人化することが可能となる。 また、装缶を終了したド
ラム缶70すべてについて、プラグPの締付トルクが一
定の範囲内に保たれるので、プラグPあるいはプラグ装
着部72のネジの損傷やOリングの損傷が生じる恐れが
ないと共に、収容物が大気中に漏れたり収容物中に湿気
等が混入してその品質が低下したりする恐れがなくな
る。 なお、上記実施例では、ドラム缶のねじ込みプラグ
について説明したが、この発明はねじ部を持たないプラ
グにも適用できる。また、この発明は、嵌挿体を所定方
向に移動して嵌合部に取付けあるいは取外す構成を有す
るもの、例えばラジエータの給水口部分にねじ込まれる
キャップや、ボルトやナットの締付け等にも、任意に適
用することができる。In the above embodiment, the tightening of the plug P is reduced.
Since it is performed in at least three stages, the desired tightening torque
Can be obtained with high reliability. Therefore, the position
Displacement and attitude fluctuation are large, and the center axis of the plug P
If the center axis of the plug mounting part does not match with the
Plug of regenerative drum can 70 whose release is hard to expect
The removal and attachment of the plug P to the part 72
It becomes possible to be unmanned. In addition, do
The tightening torque of the plug P is
It is kept within the specified range, so plug P or plug
There is a possibility that the screw of the attachment portion 72 and the O-ring may be damaged.
Is not leaking into the atmosphere or moisture
Etc., and there is no danger that the quality will deteriorate.
You. In the above embodiment, the screw plug of the drum can is described, but the present invention can be applied to a plug having no screw portion. Further, the present invention has a structure in which the insertion member is moved in a predetermined direction and attached or detached from the engagement portion, for example, a cap screwed into a water supply port of a radiator, a bolt or a nut, etc. Can be applied to
【0105】[0105]
【発明の効果】この発明の嵌挿体取外し方法および嵌挿
体取付け方法およびその装置並びに嵌挿体脱着ロボット
は、嵌合部や嵌合部に嵌挿された嵌挿体に位置ずれある
いは嵌挿方向の変化があっても、嵌合部からの嵌挿体の
取外しや嵌合部への嵌挿体の取付けを高い信頼性をもっ
て行なうことができる。従って、作業の無人化を達成す
ることができる。According to the present invention, there is provided a method for removing a fitting body, a method for attaching a fitting body and a device therefor, and a robot for removing a fitting body from a fitting portion or a fitting body inserted into the fitting portion. Even if there is a change in the insertion direction, the removal of the fitted insert from the fitting portion and the attachment of the fitted insert to the fitting portion can be performed with high reliability. Therefore, unmanned work can be achieved.
【0106】また、嵌合部に向けて照射した検査光を検
知して嵌挿体が嵌合部から取外されたか否かを非接触で
検査することにより、あるいは、取付けた嵌挿体の高さ
を検知してその取付け状況を検査することにより、嵌挿
体取外し・取付け作業の信頼性はいっそう向上する。The inspection light irradiated toward the fitting portion is detected.
To determine whether the insert has been removed from the
By examining, or by examining the mounting situation by detecting the height of the attached fitting interposer, fitted
The reliability of the body removal / attachment work is further improved.
【0107】[0107]
【0108】[0108]
【0109】[0109]
【図1】この発明の嵌挿体脱着ロボットを、ドラム缶の
プラグ脱着ロボットとして構成した一実施例を示す側面
説明図である。FIG. 1 is an explanatory side view showing an embodiment in which the insertion / removal robot of the present invention is configured as a plug / removal robot for a drum can.
【図2】図1のロボットのハンドの側面図である。FIG. 2 is a side view of the hand of the robot of FIG. 1;
【図3】図2のハンドの正面図である。FIG. 3 is a front view of the hand of FIG. 2;
【図4】図2のロボットハンドに取付けたエアドライバ
の制御回路図である。FIG. 4 is a control circuit diagram of an air driver attached to the robot hand of FIG.
【図5】図1のロボットと共に使用する基準プレートの
一実施例の断面図である。5 is a cross-sectional view of one embodiment of a reference plate used with the robot of FIG.
【図6】ドラム缶のプラグを取外す手順を示すフローチ
ャートである。FIG. 6 is a flowchart showing a procedure for removing a plug of a drum can.
【図7】ドラム缶のプラグを取付ける手順を示すフロー
チャートである。FIG. 7 is a flowchart showing a procedure for attaching a plug of a drum can.
【図8】基準プレート上の3点の位置の検出状況を示す
説明図である。FIG. 8 is an explanatory diagram showing detection states of three positions on a reference plate.
【図9】ドラム缶のプラグ装着部の位置の検出状況を示
す説明図である。FIG. 9 is an explanatory diagram showing a detection situation of a position of a plug mounting portion of a drum can.
【図10】プラグ装着部におけるプラグの有無の検査方
法を示す説明図である。FIG. 10 is an explanatory diagram showing a method of inspecting the presence or absence of a plug in a plug mounting portion.
【図11】プラグの締付け状況の検査方法を示す説明図
である。FIG. 11 is an explanatory view showing an inspection method of a plug fastening state.
【図12】プラグ締付け時のエアドライバ制御方法を示
すタイムチャートである。FIG. 12 is a time chart showing an air driver control method at the time of plug tightening.
【図13】プラグ締付け時の締付けトルクの変化を示す
グラフである。FIG. 13 is a graph showing a change in tightening torque at the time of plug tightening.
【図14】ドラム缶の充填孔付近の構成を示す部分断面
説明図である。FIG. 14 is a partial cross-sectional explanatory view showing a configuration near a filling hole of a drum can.
10 プラグ脱着ロボット 11 ロボット制御部 12 エアドライバ制御装置 20 本体部 21 ベース 22 第1アーム 23 第2アーム 24 手首部 25 ハンド接続部材 30 ハンド 31 接続バー 32 保持部材 33 案内バー 34 スライダ 35 圧縮バネ 36 ブラケット 37 支持プレート 40 可動プレート 41 回転軸 42 伝達軸 43 係合部材 44 把持爪 46 案内バー 47 シリンダロッド 48、49、53 センサ保持部材 50 位置センサ 50a 投光器 50b 受光器 54 変位センサ GR 把持器 DR エアドライバ CL エアシリンダ 60 基準プレート 61 本体部 62 載置部 63 把持部 70 ドラム缶 71 天板 72 プラグ装着部 73 胴板 P プラグ Pa 凹部 Pb 係止用突起 H 充填孔 DESCRIPTION OF SYMBOLS 10 Plug removal robot 11 Robot control part 12 Air driver control device 20 Main body part 21 Base 22 First arm 23 Second arm 24 Wrist part 25 Hand connecting member 30 Hand 31 Connection bar 32 Holding member 33 Guide bar 34 Slider 35 Compression spring 36 Bracket 37 Support plate 40 Movable plate 41 Rotating shaft 42 Transmission shaft 43 Engaging member 44 Gripping claw 46 Guide bar 47 Cylinder rod 48, 49, 53 Sensor holding member 50 Position sensor 50a Projector 50b Receiver 54 Displacement sensor GR Grinder DR Air Driver CL Air cylinder 60 Reference plate 61 Main body 62 Mounting section 63 Gripping section 70 Drum can 71 Top plate 72 Plug mounting section 73 Body plate P plug Pa recess Pb Locking projection H Filling hole
───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.6 識別記号 FI B25J 13/08 B25J 13/08 Z B67B 3/20 B67B 3/20 (72)発明者 松藤 健二 東京都新宿区西新宿二丁目1番1号 日 立化成工業株式会社内 (72)発明者 赤津 慶信 茨城県日立市東町四丁目13番1号 日立 化成工業株式会社 山崎工場内 (72)発明者 後藤 忠憲 茨城県日立市東町四丁目13番1号 日立 化成工業株式会社 山崎工場内 (56)参考文献 特開 昭64−37605(JP,A) 特開 昭62−105788(JP,A) 特開 平3−166084(JP,A) 特開 平3−240689(JP,A) 特開 平4−114893(JP,A) (58)調査した分野(Int.Cl.6,DB名) G05B 19/19 B25J 13/08 B67B 3/20────────────────────────────────────────────────── ─── Continued on the front page (51) Int.Cl. 6 Identification code FI B25J 13/08 B25J 13/08 Z B67B 3/20 B67B 3/20 (72) Inventor Kenji Matsufuji 2-chome Nishishinjuku, Shinjuku-ku, Tokyo No. 1-1 Inside Hitachi Chemical Co., Ltd. (72) Inventor Yoshinobu Akatsu 4-3-1-1, Higashicho, Hitachi City, Ibaraki Prefecture Inside the Yamazaki Plant of Hitachi Chemical Co., Ltd. (72) Inventor Tadanori Goto Higashimachi 4, Hitachi City, Ibaraki Prefecture No. 13-1, Hitachi Chemical Co., Ltd. Yamazaki Factory (56) References JP-A-64-37605 (JP, A) JP-A-62-105788 (JP, A) JP-A-3-1666084 (JP, A) JP-A-3-240689 (JP, A) JP-A-4-114,893 (JP, A) (58) Fields investigated (Int. Cl. 6 , DB name) G05B 19/19 B25J 13/08 B67B 3 / 20
Claims (14)
嵌合部に係合させるステップと、 上記嵌挿体または嵌合部に係合せしめられた上記基準部
材の 基準面を検出するステップと、検出した 上記基準面の位置および傾斜方向を算出するス
テップと、検出した 上記基準面と上記嵌挿体または嵌合部との位置
関係を算出するステップと、算出した 上記基準面の位置および傾斜方向並びに上記位
置関係に基づいて上記嵌挿体の位置および嵌挿方向を算
出するステップと、 算出した上記嵌挿体の位置および嵌挿方向に応じて嵌挿
体取外し手段を制御して上記嵌挿体を上記嵌合部から取
外すステップとを具備してなることを特徴とする嵌挿体
取外し方法。 A reference member having a reference surface is fitted with an insertion body or
A step of engaging the fitting portion, and the reference portion engaged with the fitting insert or the fitting portion.
Calculating and detecting a reference surface of the wood, a step of calculating the position and direction of inclination of the reference plane detected, the positional relationship between the detected the reference surface and the fitting interposer or the fitting portion, calculating the position and inserting direction of the fitting interposer based on the calculated position and the inclination direction and the positional relationship between the reference plane, fitted in accordance with the position and inserting direction of the calculated the fitting interposer interposer removal method fitted to control the body removal means, characterized in that the fitting interposer formed by including the step of removing from the fitting portion.
知して、上記嵌挿体が上記嵌合部から取外されたか否か
を非接触で検査するステップをさらに含む請求項1に記
載の嵌挿体取外し方法。 2. An inspection light radiated toward the fitting portion is detected.
Knows whether the insert has been removed from the fit
2. The method according to claim 1, further comprising the step of:
How to remove the insert.
嵌合部に係合させる手段と、 上記嵌挿体または嵌合部に係合せしめられた上記基準部
材の基準面を検出する手段と、 検出した上記基準面の位置および傾斜方向を算出する手
段と、 検出した上記基準面と上記嵌挿体または嵌合部との位置
関係を算出する手段と、 算出した上記基準面の位置および傾斜方向並びに上記位
置関係に基づいて上記嵌挿体の位置および嵌挿方向を算
出する手段と、 上記嵌挿体を上記嵌合部から取外す作業を行なう嵌挿体
取外し手段と、 算出した上記嵌挿体の位置および嵌挿方向に応じて上記
嵌挿体取外し手段を制御する制御手段とを具備してなる
ことを特徴とする嵌挿体取外し装置。 3. A reference member having a reference surface is fitted with an insertion body or
Means for engaging the fitting portion, and the reference portion engaged with the fitting insert or the fitting portion
Means for detecting the reference plane of the material, and means for calculating the position and inclination direction of the detected reference plane.
Step, and the position of the detected reference surface and the inserted body or the fitted portion.
Means for calculating the relationship, the calculated position and tilt direction of the reference plane, and the position
The position and the insertion direction of the insert are calculated based on the
Ejecting means, and a work for removing the fitting from the fitting portion
Removal means, according to the calculated position and insertion direction of the insertion body,
Control means for controlling the insertion member removing means.
A fitting / inserting body removing device characterized by the above-mentioned.
知して、上記嵌挿体が上記嵌合部から取外されたか否か
を非接触で検査する手段をさらに含む請求項3に記載の
嵌挿体取外し装置。 4. An inspection light radiated toward the fitting portion is detected.
Knows whether the insert has been removed from the fit
4. The method according to claim 3, further comprising: means for inspecting the contactlessly.
Insertion body removal device.
させるステップと、 上記嵌合部に係合せしめられた上記基準部材の基準面を
検出するステップと、 検出した上記基準面の位置および傾斜方向を算出するス
テップと、 検出した上記基準面と上記嵌合部との位置関係を算出す
るステップと、 算出した上記基準面の位置および傾斜方向並びに上記位
置関係に基づいて上記嵌合部の位置および嵌挿方向を算
出するステップと、 算出した上記嵌合部の位置および嵌挿方向に応じて嵌挿
体取付け手段を制御して上記嵌挿体を上記嵌合部に取付
けるステップとを具備してなることを特徴とする嵌挿体
取付け方法。 5. A reference member having a reference surface is engaged with a fitting portion.
A step of the reference surface of the engaging combined crimped the reference member in the fitting portion
Detecting, and calculating the detected position and inclination direction of the reference plane.
And calculating the positional relationship between the detected reference plane and the fitting portion.
And the calculated position and inclination direction of the reference plane and the position
The position and the insertion direction of the fitting part are calculated based on the
Ejecting , and inserting and inserting according to the calculated position and the inserting direction of the fitting portion.
Control the body attachment means to attach the insert to the fitting
Insertion step.
Mounting method.
高さを検知してその取付け状況を検査するステップをさ
らに含む請求項5に記載の嵌挿体取付け方法。 6. The fitting insert attached to the fitting portion.
Detect the height and check the mounting status.
The method according to claim 5, further comprising the steps of:
テップと、 検出した上記基準面と上記嵌合部との位置関係を算出す
るステップと、 算出した上記基準面の位置および傾斜方向並びに上記位
置関係に基づいて上記嵌合部の位置および嵌挿方向を算
出するステップと、 算出した上記嵌合部の位置および嵌挿方向に応じて嵌挿
体取付け手段を制御して上記嵌挿体を上記嵌合部に取付
けるステップと、 上記嵌合部に取付けられた上記嵌挿体の高さを検知して
その取付け状況を検査するステップとを具備してなるこ
とを特徴とする嵌挿体取付け方法。 7. A step of detecting a reference plane of the fitting portion, and a step of calculating a position and an inclination direction of the detected reference plane.
And calculating the positional relationship between the detected reference plane and the fitting portion.
And the calculated position and inclination direction of the reference plane and the position
The position and the insertion direction of the fitting part are calculated based on the
Ejecting , and inserting and inserting according to the calculated position and the inserting direction of the fitting portion.
Control the body attachment means to attach the insert to the fitting
And detecting the height of the insert body attached to the fitting portion.
Inspecting the mounting condition.
And a method for mounting the insert.
させる手段と、 上記嵌合部に係合せしめられた上記基準部材の基準面を
検出する手段と、 検出した上記基準面の位置および傾斜方向を算出する手
段と、 検出した上記基準面と上記嵌合部との位置関係を算出す
る手段と、 算出した上記基準面の位置および傾斜方向並びに上記位
置関係に基づいて上記嵌合部の位置および嵌挿方向を算
出する手段と、 上記嵌挿体を上記嵌合部に取付ける作業を行なう嵌挿体
取付け手段と、 算出した上記嵌合部の位置および嵌挿方向に応じて上記
嵌挿体取付け手段を制御する制御手段とを具備してなる
ことを特徴とする嵌挿体取付け装置。 8. A reference member having a reference surface is engaged with a fitting portion.
Means for making the reference surface of the reference member engaged with the fitting portion
Means for detecting, and means for calculating the detected position and tilt direction of the reference plane
And calculating the positional relationship between the step and the detected reference surface and the fitting portion.
Means, the calculated position and inclination direction of the reference plane, and the position
The position and the insertion direction of the fitting part are calculated based on the
Ejecting means, and a work for attaching the fitting to the fitting portion
According to the mounting means and the calculated position and insertion direction of the fitting portion,
And control means for controlling the insertion member mounting means.
A fitting insertion device, characterized in that:
高さを検知してその取付け状況を検査する手段をさらに
含む請求項8に記載の嵌挿体取付け装置。 9. The fitting insert attached to the fitting portion.
Additional means for detecting height and checking the mounting status
The mounting device according to claim 8, further comprising:
段と、 検出した上記基準面と上記嵌合部との位置関係を算出す
る手段と、 算出した上記基準面の位置および傾斜方向並びに上記位
置関係に基づいて上記嵌合部の位置および嵌挿方向を算
出する手段と、 上記嵌挿体を上記嵌合部に取付ける作業を行なう嵌挿体
取付け手段と、 算出した上記嵌合部の位置および嵌挿方向に応じて上記
嵌挿体取付け手段を制御する制御手段と、 上記嵌合部に取付けられた上記嵌挿体の高さを検知して
その取付け状況を検査する手段とを具備してなることを
特徴とする嵌挿体取付け装置。 10. A means for detecting a reference plane of a fitting portion, and means for calculating a position and an inclination direction of the detected reference plane.
And calculating the positional relationship between the step and the detected reference surface and the fitting portion.
Means, the calculated position and inclination direction of the reference plane, and the position
The position and the insertion direction of the fitting part are calculated based on the
Ejecting means, and a work for attaching the fitting to the fitting portion
According to the mounting means and the calculated position and insertion direction of the fitting portion,
Control means for controlling the insertion body mounting means, and detecting the height of the insertion body mounted on the fitting portion;
Means for inspecting the state of attachment.
A fitting insert mounting device characterized by the following.
は嵌合部に係合させる手段と、 上記嵌挿体または嵌合部に係合せしめられた上記基準部
材の基準面を検出する手段と 検出した上記基準面の位置
および傾斜方向を算出する手段と、 検出した上記基準面と上記嵌挿体または嵌合部との位置
関係を算出する手段と、 算出した上記基準面の位置および傾斜方向並びに上記位
置関係に基づいて上記嵌挿体または嵌合部の位置および
嵌挿方向を算出する手段と、 上記嵌挿体を上記嵌合部から取外す作業を行なう嵌挿体
取外し手段と、 上記嵌挿体を上記嵌合部に取付ける作業を行なう嵌挿体
取付け手段と、 算出した上記嵌挿体または嵌合部の位置および嵌挿方向
に応じて上記嵌挿体取外し手段を制御する第1制御手段
と、 算出した上記嵌挿体または嵌合部の位置および嵌挿方向
に応じて上記嵌挿体取付け手段を制御する第2制御手段
と を具備してなることを特徴とする嵌挿体脱着ロボッ
ト。11. A reference member having a reference surface is fitted with an insertion body or
Means for engaging the fitting portion, and the reference portion engaged with the fitting insert or the fitting portion
Means for detecting the reference plane of the material and the detected position of the reference plane
Means for calculating the tilt direction and the position of the detected reference surface and the detected insertion body or the fitted portion.
Means for calculating the relationship, the calculated position and tilt direction of the reference plane, and the position
And the position of the fitting or fitting part based on the
Means for calculating a fitting direction, and a fitting body for removing the fitting body from the fitting portion
Detachment means and a fitting for performing the work of attaching the fitting to the fitting portion
Attachment means, and calculated position and direction of the fitted body or fitting portion
Control means for controlling the insertion member removing means according to
And the calculated position and direction of the fitting body or fitting part
Control means for controlling the fitting body attaching means according to
A detachable insertion / removal robot, comprising:
の高さを検知してその取付け状況を検査する手段をさら
に含む請求項11に記載の嵌挿体脱着ロボット。12. The fitting body attached to the fitting part.
Means to detect the height of the
The robot according to claim 11, wherein
検知して、上記嵌挿体が上記嵌合部から取外されたか否
かを非接触で検査する手段をさらに含む請求項11に記
載の嵌挿体脱着ロボット。13. An inspection light radiated toward the fitting portion.
Detects whether or not the inserted body has been removed from the fitted portion
12. The method according to claim 11, further comprising:
The insertion / removal robot of the insert.
る手段と、 検出した上記基準面の位置および傾斜方向を算出する手
段と、 検出した上記基準面と上記嵌挿体または嵌合部との位置
関係を算出する手段と、 算出した上記基準面の位置および傾斜方向並びに上記位
置関係に基づいて上記嵌挿体または嵌合部の位置および
嵌挿方向を算出する手段と、 上記嵌挿体を上記嵌合部から取外す作業を行なう嵌挿体
取外し手段と、 上記嵌挿体を上記嵌合部に取付ける作業を行なう嵌挿体
取付け手段と、 算出した上記嵌挿体または嵌合部の位置および嵌挿方向
に応じて上記嵌挿体取外し手段を制御する第1制御手段
と、 算出した上記嵌挿体または嵌合部の位置および嵌挿方向
に応じて上記嵌挿体取付け手段を制御する第2制御手段
と、 上記嵌合部に取付けられた上記嵌挿体の高さを検知して
その取付け状況を検査する手段とを具備してなることを
特徴とする 嵌挿体脱着ロボット。14. A method for detecting a reference surface of a fitting body or a fitting part.
Means for calculating the position and inclination direction of the detected reference plane.
Step, and the position of the detected reference surface and the inserted body or the fitted portion.
Means for calculating the relationship, the calculated position and tilt direction of the reference plane, and the position
And the position of the fitting or fitting part based on the
Means for calculating a fitting direction, and a fitting body for removing the fitting body from the fitting portion
Detachment means and a fitting for performing the work of attaching the fitting to the fitting portion
Attachment means, and calculated position and direction of the fitted body or fitting portion
Control means for controlling the insertion member removing means according to
And the calculated position and direction of the fitting body or fitting part
Control means for controlling the fitting body attaching means according to
And detecting the height of the insert body attached to the fitting portion
Means for inspecting the state of attachment.
Characterized by the insertion / removal robot.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP3097585A JP2781078B2 (en) | 1990-10-15 | 1991-04-26 | Insert / insert body removing method, insert / insert body attaching method and apparatus thereof, and insert / insert body attaching / detaching robot |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP27573190 | 1990-10-15 | ||
JP2-275731 | 1990-10-15 | ||
JP3097585A JP2781078B2 (en) | 1990-10-15 | 1991-04-26 | Insert / insert body removing method, insert / insert body attaching method and apparatus thereof, and insert / insert body attaching / detaching robot |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH04227505A JPH04227505A (en) | 1992-08-17 |
JP2781078B2 true JP2781078B2 (en) | 1998-07-30 |
Family
ID=26438751
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP3097585A Expired - Lifetime JP2781078B2 (en) | 1990-10-15 | 1991-04-26 | Insert / insert body removing method, insert / insert body attaching method and apparatus thereof, and insert / insert body attaching / detaching robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2781078B2 (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5652620B2 (en) * | 2011-07-19 | 2015-01-14 | トヨタ自動車株式会社 | Bolt / nut tightening method and bolt / nut tightening device |
DE202015102825U1 (en) * | 2015-06-01 | 2016-09-02 | Kuka Systems Gmbh | Plug fastening tool |
JP6899353B2 (en) * | 2018-06-04 | 2021-07-07 | 荏原冷熱システム株式会社 | Manufacturing method of automatic work equipment and shell and tube heat exchanger |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0676071B2 (en) * | 1985-10-31 | 1994-09-28 | マツダ株式会社 | Automatic cap opening / closing device |
JPH0830977B2 (en) * | 1987-08-04 | 1996-03-27 | 株式会社明電舎 | Robot copy control device |
-
1991
- 1991-04-26 JP JP3097585A patent/JP2781078B2/en not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JPH04227505A (en) | 1992-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7600306B2 (en) | Robotic apparatus and method for mounting a valve stem on a wheel rim | |
US7715946B2 (en) | Industrial robot | |
CN101548201B (en) | Collimator changer | |
US6481083B1 (en) | Robotic apparatus and method for mounting a vale stem on a wheel rim | |
CN113546811B (en) | Gluing monitoring equipment and gluing quality monitoring method | |
TWI693134B (en) | Substrate transfer robot | |
JP2016129923A (en) | Unmanned vehicle | |
JP2781078B2 (en) | Insert / insert body removing method, insert / insert body attaching method and apparatus thereof, and insert / insert body attaching / detaching robot | |
KR100809535B1 (en) | Pipe assembling method | |
JP2022181522A (en) | Liquid supply device and liquid supply method | |
CN213948633U (en) | Mounting system for mounting vehicle body accessory on vehicle body | |
JP7376916B2 (en) | Work supply/removal system, portable robot device, and portable work stocker | |
CN110936147A (en) | Novel intelligent automatic screw machine | |
JP2008168405A (en) | Assembly method of gear device and phase alignment tool | |
JP2000094241A (en) | Inspection device for thread fastening dimension | |
JP2017052068A (en) | Fastening working method and fastening system | |
CN115741726A (en) | Robot fuzzy grabbing system and process flow method | |
CN115213677A (en) | Automatic assembling machine for breather valve | |
KR20230027431A (en) | Assembly Tool | |
CN114799804B (en) | Robot tightening detection device for axle brake drum installation and application method thereof | |
JP2019155565A (en) | Screw fastening system and screw fastening method | |
US20230129083A1 (en) | Gas cylinder automation system | |
CN115781213B (en) | Method for automatically feeding module into box body | |
TWI821596B (en) | Gas container connecting apparatus | |
JPH0532183B2 (en) |