JPH06285402A - Method of controlling rate of flow of sealing agent in sealing robot - Google Patents
Method of controlling rate of flow of sealing agent in sealing robotInfo
- Publication number
- JPH06285402A JPH06285402A JP5096441A JP9644193A JPH06285402A JP H06285402 A JPH06285402 A JP H06285402A JP 5096441 A JP5096441 A JP 5096441A JP 9644193 A JP9644193 A JP 9644193A JP H06285402 A JPH06285402 A JP H06285402A
- Authority
- JP
- Japan
- Prior art keywords
- sealing
- robot
- pressure
- sealant
- seal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000007789 sealing Methods 0.000 title claims abstract description 186
- 238000000034 method Methods 0.000 title claims description 19
- 239000000565 sealant Substances 0.000 claims description 85
- 239000003795 chemical substances by application Substances 0.000 claims description 17
- 239000007921 spray Substances 0.000 claims description 10
- 210000000707 wrist Anatomy 0.000 claims description 8
- 239000011324 bead Substances 0.000 abstract description 72
- 238000010586 diagram Methods 0.000 description 8
- 230000001133 acceleration Effects 0.000 description 4
- 230000001360 synchronised effect Effects 0.000 description 2
- 239000011248 coating agent Substances 0.000 description 1
- 238000000576 coating method Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
Landscapes
- Coating Apparatus (AREA)
- Manipulator (AREA)
- Spray Control Apparatus (AREA)
Abstract
Description
【0001】[0001]
【産業上の利用分野】本発明は、シールング作業をロボ
ットによって行わせるシール剤の流量制御方法に関す
る。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a method of controlling a flow rate of a sealing agent which allows a robot to perform a sealing operation.
【0002】[0002]
【従来の技術】シールガンをロボットアーム先端の手首
に取付け、ロボットにシーリング作業動作を教示して、
ロボットによってシーリング作業を行うことは一般的に
行われている。従来から行われているこのロボットによ
るシーリング作業の制御は、ロボット制御装置とは別に
シール剤供給制御装置を設け、ロボット制御装置からの
シール開始、もしくは停止指令等の制御信号に基づい
て、シール剤供給制御装置が、シール剤供給ポンプを制
御している。また、シールガンにはシール剤の塗布を棒
状ノズルで行うタイプとスプレーノズルで行うタイプが
あり、前者は線状にシール剤を対象物に塗布する場合に
使用され、後者は対象物が面状で該面にシール剤を塗布
するような場合に使用される。2. Description of the Related Art A seal gun is attached to a wrist at the end of a robot arm to teach a robot a sealing operation,
It is common practice to perform sealing work by robots. Conventionally, the control of the sealing work by this robot is provided with a sealant supply control device separately from the robot control device, and based on a control signal such as a seal start or stop command from the robot control device, the sealant is supplied. The supply control device controls the sealant supply pump. In addition, there are two types of seal guns, one that applies the sealant using a rod-shaped nozzle and the other that uses a spray nozzle.The former is used to apply the sealant linearly to the target object, and the latter is a planar object. It is used when a sealant is applied to the surface.
【0003】[0003]
【発明が解決しようとする課題】棒状ノズルを備えたシ
ールガンではロボット移動時におけるビードの膜厚を一
定にする必要上シール剤供給ポンプの速度制御をロボッ
トの移動速度に比例させることが一般に行われている
が、シールガンの内圧制御に関しては積極的に行われて
はいない。このため、シールガンのノズルシャッタが開
放される直前のシールガンの内圧、即ち、塗布開始時に
おけるシール剤の噴出力が様々に変動し、ビードの膜厚
が安定しなくなるという問題があった。例えば、図6に
示されるように、第1回目のシーリング動作開始位置P
2にロボットの手首が移動するまでの教示位置区間P1
−P2で区間P2−P3のロボット移動速度に適応する
初動噴出圧力にシールガンの内圧Psを保持することが
可能であったとしても、教示位置P3で第1回目のシー
リング動作が完了してシールガンのノズルシャッタを閉
鎖したときにシール剤供給ポンプに慣性によるオーバー
トラベルが生じたりすると、シールガンの内圧が必要以
上に高まり、第2回目のシーリング動作開始位置P4で
ノズルシャッタを開いた瞬間にシール材が強力に噴出し
てビードの膜厚が厚くなったりするといった恐れがあ
る。また、シールガンの内圧を積極的に制御するという
ことがないので、第2回目以降のシーリング動作の開始
位置でビードの膜厚が厚くなるのをどうしても防止した
ければ、シールガン内部のシール剤をパージして圧力を
下げる必要が生じるが、不用意にシール剤を飛散させる
わけにもゆかない。In a seal gun having a rod-shaped nozzle, it is generally necessary to make the speed control of the sealant supply pump proportional to the moving speed of the robot because it is necessary to keep the bead thickness constant when the robot moves. However, the internal pressure of the seal gun is not actively controlled. Therefore, there is a problem in that the internal pressure of the seal gun immediately before the nozzle shutter of the seal gun is opened, that is, the jetting force of the sealant at the start of application varies, and the bead film thickness becomes unstable. For example, as shown in FIG. 6, the first sealing operation start position P
Teaching position section P1 until the wrist of the robot moves to 2
Even if the internal pressure Ps of the seal gun can be maintained at the initial blast pressure adapted to the robot moving speed in the section P2-P3 in -P2, the first sealing operation is completed at the teaching position P3 and the seal gun If the sealant supply pump causes overtravel due to inertia when the nozzle shutter is closed, the internal pressure of the seal gun rises more than necessary, and the sealant is removed at the moment when the nozzle shutter is opened at the second sealing operation start position P4. There is a risk that the bead will become thicker by ejecting strongly. In addition, since the internal pressure of the seal gun is not actively controlled, if it is absolutely necessary to prevent the bead film thickness from increasing at the start position of the second and subsequent sealing operations, the sealant inside the seal gun is purged. Then, it becomes necessary to reduce the pressure, but it is not possible to inadvertently scatter the sealant.
【0004】一方、スプレーノズルを備えたシールガン
ではシール剤供給ポンプの駆動力、つまり、シールガン
の内圧を常に一定の値に保つべく圧力制御を行うことで
シール剤のビード幅を保持するようにしていたが、シー
ルガンのノズルシャッタが開放された直後、即ち、塗布
開始時において一時的にシールガンの内圧が下降するた
め、シーリング開始直後のビード幅が減少するといった
問題があった。例えば、図7に示されるように、第1回
目のシーリング動作開始位置Q2にロボットの手首が移
動するまでの教示位置区間Q1−Q2,第1回目のシー
リング動作の教示位置区間Q2−Q3,第1回目のシー
リング動作完了位置Q3から第2回目のシーリング動作
開始位置Q4にロボットの手首が移動するまでの教示位
置区間Q3−Q4、および、第2回目のシーリング動作
の教示位置区間Q4−Q5の各々で全体としてシールガ
ンの内圧を一定の値Psに保つことができたとしても、
教示位置Q2,Q4でノズルシャッタを開いた直後には
必ず一時的にシールガンの内圧が下降する。そして、こ
の圧力降下が補償されてシールガンの内圧が再び設定値
Psに復帰するまでには時間的な遅れが伴うため、シー
リング開始直後のビード幅が減少するといった恐れがあ
る。On the other hand, in a seal gun equipped with a spray nozzle, the bead width of the seal agent is maintained by controlling the driving force of the seal agent supply pump, that is, the internal pressure of the seal gun so as to always keep a constant value. However, immediately after the nozzle shutter of the seal gun is opened, that is, at the start of coating, the internal pressure of the seal gun is temporarily lowered, so that there is a problem that the bead width immediately after the start of sealing is reduced. For example, as shown in FIG. 7, the teaching position section Q1-Q2 until the wrist of the robot moves to the first sealing operation start position Q2, the teaching position section Q2-Q3 of the first sealing operation, and the teaching position section Q2-Q3. The teaching position section Q3-Q4 from the first sealing operation completion position Q3 to the second sealing operation start position Q4 until the wrist of the robot moves, and the teaching position section Q4-Q5 of the second sealing operation. Even if the internal pressure of the seal gun as a whole can be maintained at a constant value Ps,
Immediately after opening the nozzle shutter at the teaching positions Q2 and Q4, the internal pressure of the seal gun always temporarily drops. Since there is a time delay until the internal pressure of the seal gun returns to the set value Ps again by compensating for this pressure drop, the bead width immediately after the start of sealing may decrease.
【0005】また、いずれのものも速度制御のための比
例ゲインや圧力制御のための設定値として常に一定の値
を用いるようにしていたため、ロボットの教示プログラ
ムによってビードの膜厚や幅を変更することはできなか
った。Further, in each of these cases, a constant gain is always used as a proportional gain for speed control and a set value for pressure control. Therefore, the bead thickness and width are changed by a robot teaching program. I couldn't do that.
【0006】そこで、本発明の目的は、これら従来技術
の欠点を解消し、安定したビード幅や膜厚を得ることが
でき、また、ロボットの教示プログラムによりビードの
幅や膜厚のシーリング条件を各教示区間に対して任意に
設定することのできるシーリングロボットにおけるシー
ル剤の流量制御方法を提供することにある。Therefore, an object of the present invention is to eliminate these drawbacks of the prior art, to obtain a stable bead width and film thickness, and to control the bead width and film thickness sealing conditions by a robot teaching program. It is an object of the present invention to provide a method for controlling the flow rate of a sealant in a sealing robot, which can be arbitrarily set for each teaching section.
【0007】[0007]
【課題を解決するための手段】ロボット制御装置の付加
軸制御回路にシール剤供給ポンプを接続すると共に、シ
ールガンにはシール剤の圧力を検出する圧力センサを設
ける。A sealant supply pump is connected to an additional axis control circuit of a robot controller, and a pressure sensor for detecting the pressure of the sealant is provided on the seal gun.
【0008】棒状ノズルでシール剤の塗布を行うシール
ガンの場合には、シーリング実行時にロボットの移動速
度に所定の比例ゲインを乗じた速度指令でシール剤供給
ポンプのモータの回転速度を制御してシールガンにシー
ル剤を供給する一方、シーリング非実行時にはシールガ
ンに設けられた圧力センサによりシール剤の圧力を検出
し、該検出圧力が設定圧力となるように前記モータの駆
動トルクをフィードバック制御することにより、安定し
たビード膜厚を得る。また、比例ゲインおよびシール剤
の設定圧力をシーリング動作におけるロボット教示位置
に対応して教示プログラム中に設定することにより、各
教示区間毎にビードの膜厚を任意に変更できるようにし
た。In the case of a seal gun that applies a sealant using a rod-shaped nozzle, the seal gun is controlled by controlling the rotation speed of the motor of the sealant supply pump with a speed command obtained by multiplying the moving speed of the robot by a predetermined proportional gain when performing sealing. While supplying the sealant to the sealant, when the sealing is not performed, the pressure of the sealant is detected by the pressure sensor provided in the seal gun, and the drive torque of the motor is feedback-controlled so that the detected pressure becomes the set pressure. Obtain a stable bead thickness. Further, by setting the proportional gain and the set pressure of the sealant in the teaching program corresponding to the robot teaching position in the sealing operation, the bead film thickness can be arbitrarily changed for each teaching section.
【0009】スプレーノズルでシール剤の塗布を行うシ
ールガンの場合には、シーリング実行時におけるシール
剤の設定圧力とシーリング非実行時におけるシール剤の
設定圧力とを区別してロボット制御装置に設定し、シー
ルガンに設けられた圧力センサによりシール剤の圧力を
逐次検出して、該検出圧力が設定圧力となるようにシー
ル剤供給ポンプのモータの駆動トルクをフィードバック
制御することにより、安定したビード幅を得る。また、
シール剤の設定圧力をシーリング動作におけるロボット
教示位置に対応して教示プログラム中に設定することに
より、各教示区間毎にビードの幅を任意に変更できるよ
うにした。In the case of a seal gun in which the sealant is applied with a spray nozzle, the set pressure of the sealant when the sealing is performed and the set pressure of the sealant when the sealing is not performed are set in the robot controller separately, and the seal gun is set. The pressure of the sealant is sequentially detected by the pressure sensor provided at the position, and the driving torque of the motor of the sealant supply pump is feedback-controlled so that the detected pressure becomes the set pressure, thereby obtaining a stable bead width. Also,
By setting the set pressure of the sealant in the teaching program corresponding to the robot teaching position in the sealing operation, the bead width can be arbitrarily changed for each teaching section.
【0010】[0010]
【作用】棒状ノズルを備えたシールガンにおいては、ロ
ボットの移動速度に所定の比例ゲインを乗じた速度指令
でシール剤供給ポンプのモータの回転速度を制御してシ
ールガンにシール剤を供給するので、対象物の単位距離
当りに塗布されるシール剤の量がロボットの移動速度に
関わりなく一定の値に保たれ、ビードの膜厚が比例ゲイ
ンに対応する値に保持される。また、シーリング非実行
時には圧力センサによって検出されるシール剤の圧力が
設定圧力となるようにモータの駆動トルクがフィードバ
ック制御されるので、シーリング開始時点におけるシー
ル剤の初動圧力が安定し、シーリング開始直後のビード
の膜厚が安定する。ビードの膜厚は、比例ゲインおよび
シール剤の設定圧力をシーリング動作におけるロボット
教示位置に対応して教示プログラム中に書き込むことに
よって任意に設定することができる。In the seal gun equipped with the rod-shaped nozzle, the seal agent is supplied to the seal gun by controlling the rotation speed of the motor of the seal agent supply pump by a speed command obtained by multiplying the moving speed of the robot by a predetermined proportional gain. The amount of the sealant applied per unit distance of the object is maintained at a constant value regardless of the moving speed of the robot, and the bead film thickness is maintained at a value corresponding to the proportional gain. In addition, since the drive torque of the motor is feedback controlled so that the pressure of the sealant detected by the pressure sensor becomes the set pressure when the sealing is not executed, the initial dynamic pressure of the sealant at the start of sealing is stable and immediately after the start of sealing. The bead thickness is stable. The bead film thickness can be arbitrarily set by writing the proportional gain and the set pressure of the sealant in the teaching program corresponding to the robot teaching position in the sealing operation.
【0011】スプレーノズルを備えたシールガンにおい
ては、シーリング実行時におけるシール剤の設定圧力と
シーリング非実行時におけるシール剤の設定圧力とを区
別してロボット制御装置に設定するようにしたので、シ
ーリング非実行時における設定圧力を大きめに設定する
ことによりシーリング開始時の初動圧力を増大させるこ
とができる。よって、シーリング開始時の初動圧力がシ
ーリング実行時におけるシール剤の設定圧力よりも下降
することを防止することが可能となり、ノズルシャッタ
の開放に伴う圧力降下を補償した状態で、シーリング開
始直後のビード幅の減少を防止することができる。ま
た、シールガンに設けられた圧力センサによりシール剤
の圧力を逐次検出し、該検出圧力が設定圧力となるよう
にシール剤供給ポンプのモータの駆動トルクがフィード
バック制御されるので、シーリング実行時におけるビー
ド幅が安定する。ビードの幅は、シール剤の設定圧力を
シーリング動作におけるロボット教示位置に対応して教
示プログラム中に書き込むことによって任意に設定する
ことができる。In the seal gun equipped with the spray nozzle, the set pressure of the sealant when the sealing is performed and the set pressure of the sealant when the sealing is not performed are set separately in the robot controller, so that the seal is not performed. The initial pressure at the start of sealing can be increased by setting the set pressure at the time higher. Therefore, it is possible to prevent the initial dynamic pressure at the start of sealing from falling below the set pressure of the sealing agent at the time of performing sealing, and in the state in which the pressure drop accompanying the opening of the nozzle shutter is compensated for, the bead immediately after the start of sealing is It is possible to prevent the width from decreasing. Further, the pressure of the sealant is sequentially detected by the pressure sensor provided in the seal gun, and the drive torque of the motor of the sealant supply pump is feedback-controlled so that the detected pressure becomes the set pressure. The width is stable. The width of the bead can be arbitrarily set by writing the set pressure of the sealant in the teaching program corresponding to the robot teaching position in the sealing operation.
【0012】[0012]
【実施例】図1は、本発明の一実施例を実施するシーリ
ングロボットの要部ブロック図である。10はロボット
制御装置で、プロセッサ(CPU)11、制御プログラ
ムを記憶するROM12、データの一時記憶等に利用さ
れるRAM13、教示プログラム等を記憶する不揮発性
メモリ14、表示装置付きの教示操作盤15、ロボット
の各軸の駆動源(サーボモータ)を駆動制御する軸制御
回路16、ロボットの各軸以外の軸の制御のために付加
的に設けられた付加軸制御回路17および入出力インタ
ーフェイス18がバス接続されている。また、軸制御回
路16には、ロボット本体20の各軸駆動源(サーボモ
ータ)が接続され、付加軸制御回路17には、シール剤
をシールガン30bに供給するシール剤供給ポンプのモ
ータ30aが接続されている。シールガン30bはロボ
ット本体20のアーム先端の手首に取り付けられてお
り、シールガン30bの先端にはシール剤の圧力を検出
する圧力センサ40が取り付けられ、該圧力センサ40
の出力はロボット制御装置10における入出力インター
フェイス18のアナログ入力端子に接続されている。ま
た、シールガン30bには、シール剤の吐出をON/O
FF制御するノズルシャッタがあり、電磁弁によって制
御されるようになっている。この電磁弁は入出力インタ
ーフェイス18に接続され、ロボット制御装置10によ
って制御されれる。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS FIG. 1 is a block diagram of a main part of a sealing robot for carrying out an embodiment of the present invention. A robot controller 10 includes a processor (CPU) 11, a ROM 12 for storing a control program, a RAM 13 used for temporary storage of data, a non-volatile memory 14 for storing a teaching program, and a teaching operation panel 15 with a display device. An axis control circuit 16 for driving and controlling a drive source (servo motor) for each axis of the robot, an additional axis control circuit 17 and an input / output interface 18 additionally provided for controlling axes other than each axis of the robot. Bus connected. Further, each axis drive source (servo motor) of the robot body 20 is connected to the axis control circuit 16, and the motor 30a of the sealant supply pump for supplying the sealant to the seal gun 30b is connected to the additional axis control circuit 17. Has been done. The seal gun 30b is attached to the wrist at the end of the arm of the robot body 20, and a pressure sensor 40 for detecting the pressure of the sealant is attached to the end of the seal gun 30b.
Is connected to the analog input terminal of the input / output interface 18 in the robot controller 10. Further, the seal gun 30b is turned on / off with the discharge of the sealing agent.
There is a nozzle shutter for FF control, which is controlled by a solenoid valve. This solenoid valve is connected to the input / output interface 18 and controlled by the robot controller 10.
【0013】次に、棒状ノズルのタイプのシールガン3
0bをロボット手首に取付けてシーリング作業を行うと
きの動作を図2に示すロボット制御装置のプロセッサ1
1が所定周期毎実施する処理のフローチャートと共に説
明する。Next, a stick-shaped nozzle-type seal gun 3
0b is attached to the robot wrist to perform a sealing operation. The processor 1 of the robot controller shown in FIG.
A description will be given with reference to a flowchart of a process performed by 1 in every predetermined cycle.
【0014】まず、ロボットに対して、シールガン30
bの移動経路が予め教示され、動作教示プログラムがす
でに不揮発性メモリ14に格納されているものとする。
また、教示プログラムには、移動経路の各教示位置に応
じ、該教示位置に対応する移動区間の制御データがプロ
グラム設定されている。即ち、移動区間がシーリング実
行区間であれば、シール剤供給ポンプのモータ30aの
回転速度を所望のビード膜厚に対応して制御するための
速度制御比例ゲインの値が教示位置に対応してプログラ
ム設定され、また、移動区間がシーリング非実行区間で
あれば、シール剤圧力制御の目標値となる圧力の値が教
示位置に対応してプログラム設定されており、速度制御
比例ゲインおよび目標値となる圧力の値はロボットの現
在位置が各教示位置に到達する毎に、順次、RAM13
内の速度制御比例ゲイン記憶レジスタk2および目標値
記憶レジスタPsの各々に更新記憶されるようになって
いる。なお、速度制御比例ゲインと目標値となる圧力と
が同時に利用されることはないので、速度制御比例ゲイ
ン記憶レジスタk2と目標値記憶レジスタPsとは実質
的に同じレジスタで良い。First, for the robot, the seal gun 30
It is assumed that the movement route of b is taught in advance and the motion teaching program is already stored in the non-volatile memory 14.
Further, in the teaching program, control data of a moving section corresponding to each teaching position of the moving route is set as a program in accordance with each teaching position. That is, if the movement section is the sealing execution section, the value of the speed control proportional gain for controlling the rotation speed of the motor 30a of the sealant supply pump in correspondence with the desired bead film thickness corresponds to the teaching position. If the moving section is set and the sealing section is a non-sealing section, the target pressure value of the sealant pressure control is programmed corresponding to the taught position, and the speed control proportional gain and target value are set. The value of the pressure is sequentially stored in the RAM 13 each time the current position of the robot reaches each teaching position.
It is adapted to be updated and stored in each of the speed control proportional gain storage register k2 and the target value storage register Ps. Since the speed control proportional gain and the pressure that is the target value are not used at the same time, the speed control proportional gain storage register k2 and the target value storage register Ps may be substantially the same register.
【0015】図4は移動経路の教示位置とシーリング実
行区間との対応関係の一例を示す概念図であり、この例
においては教示位置区間P2−P3,P4−P5がシー
リング実行区間、また、教示位置区間P1−P2,P3
−P4が位置決め移動のためのシーリング非実行区間で
ある。前述したように、シーリング実行区間においては
シール剤供給ポンプのモータ30aの回転速度を所望の
ビード膜厚に対応して制御するための速度制御が行わ
れ、また、シーリング非実行区間においてはシール剤の
圧力を次のシーリング実行区間の初動圧力に適応させる
ための圧力制御が行われる。例えば、シーリング非実行
区間P1−P2およびP3−P4のシール剤圧力の目標
値は各々教示位置P1およびP3に対応してプログラム
設定され、また、シーリング実行区間P2−P3および
P4−P5のビード膜厚に対応する速度制御比例ゲイン
は各々教示位置P2およびP4に対応してプログラム設
定されている。既に説明したように、シーリング実行区
間における速度制御比例ゲインの値は所望するビード膜
厚に対応して決められ、また、シーリング非実行区間の
圧力制御目標値は次のシーリング実行区間で必要とされ
る初動圧力に対応して決められるものであって、これら
の値は各教示位置に対応して予め教示プログラム上に設
定されている。FIG. 4 is a conceptual diagram showing an example of the correspondence between the teaching position of the moving route and the sealing execution section. In this example, the teaching position sections P2-P3 and P4-P5 are the sealing execution section and the teaching execution section. Position section P1-P2, P3
-P4 is a sealing non-execution section for positioning movement. As described above, speed control is performed in the sealing execution section to control the rotation speed of the motor 30a of the sealant supply pump in accordance with the desired bead thickness, and in the sealing non-execution section. The pressure control is performed to adapt the pressure of 1 to the initial motion pressure of the next sealing execution section. For example, the target values of the sealant pressure in the non-sealing sections P1-P2 and P3-P4 are programmed corresponding to the teaching positions P1 and P3, respectively, and the bead film in the sealing execution sections P2-P3 and P4-P5 is set. The velocity control proportional gain corresponding to the thickness is programmed in correspondence with the teaching positions P2 and P4. As described above, the value of the velocity control proportional gain in the sealing execution section is determined corresponding to the desired bead thickness, and the pressure control target value in the sealing non-execution section is required in the next sealing execution section. These values are set in advance on the teaching program corresponding to each teaching position.
【0016】運転開始指令を入力すると、プロセッサ1
1は所定周期毎、教示プログラムを1ブロック毎順次読
取り、軸制御回路16を介してロボット本体20の各軸
のサーボモータを駆動制御してロボットを駆動し、シー
ルガン30bを教示経路に沿って移動させ、また、前述
したように、シールガン30bの現在位置が各教示位置
に到達する毎に、速度制御比例ゲインおよび目標値とな
る圧力の値を順次RAM13内の速度制御比例ゲイン記
憶レジスタk2および目標値記憶レジスタPsの各々に
更新記憶することになる。そして、教示プログラムより
シーリング開始指令が読み込まれると、入出力インター
フェイス18を介してシールガン30bの電磁弁を作動
させてノズルシャッタを開放すると共に、フラグFを
「1」にセットする。また、シーリング終了指令が読み
込まれると上記電磁弁を非動作としてノズルシャッタを
閉じ、前記フラグFを「0」にセットする。さらに、プ
ロセッサ11は、所定周期(例えば、ロボットの各軸へ
移動指令を分配する分配周期と同期した周期)毎、図2
の処理を実行する。When the operation start command is input, the processor 1
1 is to sequentially read the teaching program block by block at a predetermined cycle, drive the servo motor of each axis of the robot body 20 via the axis control circuit 16 to drive the robot, and move the seal gun 30b along the teaching path. Further, as described above, each time the current position of the seal gun 30b reaches each teaching position, the speed control proportional gain and the pressure value which is the target value are sequentially set to the speed control proportional gain storage register k2 and the target in the RAM 13. It will be updated and stored in each of the value storage registers Ps. When a sealing start command is read from the teaching program, the solenoid valve of the seal gun 30b is operated via the input / output interface 18 to open the nozzle shutter and set the flag F to "1". When the sealing end command is read, the solenoid valve is deactivated and the nozzle shutter is closed, and the flag F is set to "0". Further, the processor 11 performs a predetermined cycle (for example, a cycle synchronized with a distribution cycle for distributing a movement command to each axis of the robot) as shown in FIG.
The process of is executed.
【0017】まず、前記フラグFが「1」にセットされ
ているか否か判断する(ステップa1)。フラグFに
「1」がセットされていなければ、シールガン30bが
ノズルシャッタを閉鎖した状態でシーリング非実行区間
を移動していることを意味し、また、フラグFに「1」
がセットされていれば、シールガン30bがシーリング
実行区間を移動しながらシーリング作業を行っているこ
とを意味する。First, it is judged whether or not the flag F is set to "1" (step a1). If "1" is not set in the flag F, it means that the seal gun 30b is moving in the sealing non-execution section with the nozzle shutter closed, and the flag F is "1".
If is set, it means that the seal gun 30b is performing the sealing operation while moving in the sealing execution section.
【0018】そこで、フラグFに「1」がセットされて
おらずステップa1の判別結果が真となった場合、プロ
セッサ11は、まず、圧力センサ40からシール剤の現
在圧力Pnを読取り(ステップa2)、RAM13の目
標値記憶レジスタに記憶された当該位置決め移動区間の
目標圧力値Psから該検出圧力Pnを減じ、更に、この
値に圧力制御のための設定比例ゲインk1を乗じてシー
ル剤供給ポンプのモータ30aの速度指令Vcを求め
(ステップa3)、該速度指令Vcを付加軸制御回路1
7に出力して(ステップa4)、シール剤供給ポンプの
モータ30aを駆動する。以下、フラグFに「0」がセ
ットされている間、即ち、シールガン30bが当該シー
リング非実行区間を移動する間、プロセッサ11はステ
ップa1〜ステップa4の処理を所定周期毎実行し、シ
ールガン30bの先端のシール剤圧力が目標値記憶レジ
スタの設定値Psと一致するようにシール剤供給ポンプ
のモータ30aの回転速度をフィードバック制御する。
そして、シールガン30bが次の教示位置に到達するま
でにはシール剤の現在圧力Pnが上昇または下降して目
標圧力値Psに一致する。Therefore, when the flag F is not set to "1" and the determination result of step a1 is true, the processor 11 first reads the current pressure Pn of the sealant from the pressure sensor 40 (step a2). ), The detected pressure Pn is subtracted from the target pressure value Ps of the positioning movement section stored in the target value storage register of the RAM 13, and this value is further multiplied by a set proportional gain k1 for pressure control to obtain a sealant supply pump. The speed command Vc of the motor 30a is calculated (step a3), and the speed command Vc is added to the additional axis control circuit 1
7 (step a4) to drive the motor 30a of the sealant supply pump. Hereinafter, while the flag F is set to “0”, that is, while the seal gun 30b moves in the sealing non-execution section, the processor 11 executes the processing of step a1 to step a4 every predetermined period, and the seal gun 30b is operated. The rotation speed of the motor 30a of the sealant supply pump is feedback-controlled so that the sealant pressure at the tip matches the set value Ps of the target value storage register.
By the time the seal gun 30b reaches the next taught position, the current pressure Pn of the sealant rises or falls to match the target pressure value Ps.
【0019】例えば、シールガン30bが現時点で図4
における教示位置区間P1−P2上を移動していたとす
れば、RAM13の目標値記憶レジスタから読み込まれ
る目標圧力は教示位置P1に対応する値、つまり、次の
シーリング実行区間の開始位置である教示位置P2で必
要とされる初動圧力の値であり、シールガン30bが教
示位置P2に到達するときにはシール剤の現在圧力Pn
が教示位置P2で必要とされる初動圧力Psと既に一致
している。For example, the seal gun 30b is currently shown in FIG.
If the target pressure read from the target value storage register of the RAM 13 is the value corresponding to the teaching position P1, that is, the teaching position that is the start position of the next sealing execution section, This is the value of the initial pressure required at P2, and when the seal gun 30b reaches the teaching position P2, the current pressure Pn of the sealant is present.
Has already coincided with the initial dynamic pressure Ps required at the taught position P2.
【0020】そして、シールガン30bが次の教示位置
に到達して教示プログラムからシーリング開始指令が読
みこまれると、前述したように電磁弁が作動してノズル
シャッタが開放され、シールガン30bの移動経路はシ
ーリング実行区間へと入る。この時フラグFに「1」が
セットされる結果、ステップa1の判別結果は偽とな
る。そこで、プロセッサ11は、ロボット各軸への移動
指令のパルス分配を行う前に実施される加減速処理後の
速度指令Vrを読取り、RAM13内の速度制御比例ゲ
イン記憶レジスタに記憶されている当該シーリング実行
区間の速度制御比例ゲインk2を速度指令Vrに乗じ
て、当該シーリング実行区間で指定されているビード膜
厚に対応するシール剤供給ポンプのモータ30aの速度
指令Vcを求め(ステップa5)、該速度指令Vcを付
加軸制御回路17に出力して(ステップa4)、シール
剤供給ポンプのモータ30aを駆動する。即ち、ロボッ
トの駆動を開始するときや停止するとき、または、移動
速度を変化させるときに、急激にロボットの各軸を駆動
すると、振動や衝撃が生じるので、加減速制御を行って
ロボットの各軸を徐々に加速もしくは減速する加減速処
理が行われており、ロボットの移動速度はこの加減速処
理後の移動速度Vrに追従する。そこで、この加減速処
理後の速度指令Vrを読取り、この速度Vrと速度制御
比例ゲインk2とを乗じた速度指令Vcでシール剤供給
ポンプのモータ30aを駆動すれば、シールガン30b
の棒状ノズルから対象物上の単位距離に供給されるシー
ル剤の量はシールガン30bの移動速度Vrに関係なく
速度制御比例ゲインk2に対してコンスタントな値とな
り、該移動速度Vrが変化しても速度制御比例ゲインk
2に対応した所定のビード膜厚でシーリング作業を行う
ことができる。When the seal gun 30b reaches the next teaching position and the sealing start command is read from the teaching program, the solenoid valve operates and the nozzle shutter is opened as described above, and the movement path of the seal gun 30b is changed. Enter the ceiling execution section. At this time, the flag F is set to "1", so that the determination result of step a1 becomes false. Therefore, the processor 11 reads the speed command Vr after the acceleration / deceleration processing performed before performing the pulse distribution of the movement command to each axis of the robot, and the sealing stored in the speed control proportional gain storage register in the RAM 13. The speed command proportional gain k2 of the execution section is multiplied by the speed command Vr to obtain the speed command Vc of the motor 30a of the sealant supply pump corresponding to the bead film thickness specified in the sealing execution section (step a5). The speed command Vc is output to the additional axis control circuit 17 (step a4) to drive the motor 30a of the sealant supply pump. That is, when each axis of the robot is suddenly driven at the time of starting or stopping the driving of the robot, or when changing the moving speed, vibration or impact is generated. Acceleration / deceleration processing for gradually accelerating or decelerating the axis is performed, and the moving speed of the robot follows the moving speed Vr after this acceleration / deceleration processing. Therefore, if the speed command Vr after the acceleration / deceleration processing is read and the speed command Vc obtained by multiplying the speed Vr and the speed control proportional gain k2 is used to drive the motor 30a of the sealant supply pump, the seal gun 30b is driven.
The amount of the sealant supplied from the rod-shaped nozzle at a unit distance on the object is a constant value with respect to the speed control proportional gain k2 regardless of the moving speed Vr of the seal gun 30b, and even if the moving speed Vr changes. Speed control proportional gain k
The sealing work can be performed with a predetermined bead thickness corresponding to 2.
【0021】例えば、シールガン30bが現時点でシー
リング実行区間P2−P3上を移動していたとすれば、
この時RAM13の速度制御比例ゲイン記憶レジスタか
ら読み込まれる速度制御比例ゲインk2は、教示位置P
2に対応する値、つまり、当該シーリング実行区間P2
−P3に対して指定されたビード膜厚に対応する値であ
る。シーリング非実行区間P1−P2からシーリング実
行区間P2−P3へ移行する時の教示位置P2ではノズ
ルシャッタが急激に開放されるため、シール剤の現在圧
力Pnが下降するが、教示位置P1に対応して設定され
た目標圧力Psはこのような圧力降下をも考慮した教示
位置P2での初動圧力であるから、当該シーリング実行
区間におけるシーリング開始位置P2でビード膜厚が減
少したり、また、過度の加圧によってビード膜厚が増大
したりすることはない。For example, if the seal gun 30b is currently moving on the sealing execution section P2-P3,
At this time, the speed control proportional gain k2 read from the speed control proportional gain storage register of the RAM 13 is the teaching position P.
A value corresponding to 2, that is, the sealing execution section P2
-A value corresponding to the bead thickness specified for P3. At the teaching position P2 when the sealing non-execution section P1-P2 shifts to the sealing execution section P2-P3, the nozzle shutter is suddenly opened, so that the current pressure Pn of the sealant falls, but it corresponds to the teaching position P1. Since the target pressure Ps set by the above is the initial dynamic pressure at the teaching position P2 in consideration of such pressure drop as well, the bead film thickness is reduced at the sealing start position P2 in the sealing execution section, or the excessive pressure is generated. Pressurization does not increase the bead thickness.
【0022】以下、フラグFが「1」である間、プロセ
ッサ11は各周期毎ステップa1,ステップa5,ステ
ップa4の処理を繰り返し、シール剤供給ポンプのモー
タ30aの回転速度を制御し、速度制御比例ゲインk2
の値で定まる所定のビード膜厚でシーリング作業を行う
ことになる。Hereinafter, while the flag F is "1", the processor 11 repeats the processing of step a1, step a5 and step a4 in each cycle to control the rotational speed of the motor 30a of the sealant supply pump to control the speed. Proportional gain k2
The sealing work is performed with a predetermined bead thickness determined by the value of.
【0023】そして、教示プログラムよりシーリング停
止指令が読み込まれるとシャッタノズルが閉鎖され、シ
ールガン30bはシーリング非実行区間に入る。このと
き前記フラグFが「0」にセットされる結果、プロセッ
サ11は再び前記と同様にしてステップa1〜ステップ
a4の処理を開始する。以下、プロセッサ11は、教示
プログラムの実行が完了するまでの間、ステップa1〜
ステップa4の圧力制御に関する処理とステップa1,
ステップa5,ステップa4の速度制御に関する処理と
をフラグFの値に基いて交互に実施し、シーリング実行
区間においては各シーリング実行区間毎の速度制御比例
ゲインk2で指定されたビード膜厚でシーリング作業を
行うと共に、シーリング非実行区間においては各シーリ
ング非実行区間毎の目標圧力値Psの値に基いて次のシ
ーリング実行区間の開始位置で必要とされる初動圧力を
得るための圧力制御を行う。When the sealing stop command is read from the teaching program, the shutter nozzle is closed and the seal gun 30b enters the sealing non-execution section. At this time, as a result of the flag F being set to "0", the processor 11 restarts the processing of steps a1 to a4 in the same manner as above. Hereinafter, the processor 11 performs steps a1 to a1 until the execution of the teaching program is completed.
Process related to pressure control in step a4 and step a1,
The processing relating to speed control in steps a5 and a4 is alternately performed based on the value of the flag F, and in the sealing execution section, the sealing work is performed with the bead film thickness specified by the speed control proportional gain k2 for each sealing execution section. At the same time, in the sealing non-execution section, pressure control is performed to obtain the initial dynamic pressure required at the start position of the next sealing execution section based on the target pressure value Ps for each sealing non-execution section.
【0024】この結果、各シーリング実行区間における
ビードの膜厚は各区間におけるシーリング開始位置の近
傍を含みその全てが安定し、例えば、図4に示されるよ
うな正確なビード形状を得ることができる。As a result, the bead film thickness in each sealing execution section is stable, including the vicinity of the sealing start position in each section, and for example, an accurate bead shape as shown in FIG. 4 can be obtained. .
【0025】図3は、シールガンにスプレータイプのシ
ールガンを使用する場合におけるロボット制御装置10
のプロセッサ11が実行する処理のフローチャートであ
る。FIG. 3 shows a robot controller 10 when a spray type seal gun is used as the seal gun.
11 is a flowchart of a process executed by the processor 11 of FIG.
【0026】この場合、教示プログラムには、教示位置
の区間に対応するシール剤圧力制御の目標値が各教示位
置に対応してプログラム設定されており、目標値となる
圧力の値はロボットの現在位置が各教示位置に到達する
毎に、順次、RAM13内の目標値記憶レジスタPsに
更新記憶されるようになっている。In this case, in the teaching program, the target value of the sealing agent pressure control corresponding to the section of the teaching position is programmed corresponding to each teaching position, and the target pressure value is the current value of the robot. Every time the position reaches each teaching position, the target value storage register Ps in the RAM 13 is sequentially updated and stored.
【0027】図5は移動経路の教示位置とシーリング実
行区間との対応関係の一例を示す概念図であり、この例
においては教示位置区間Q2−Q3,Q4−Q4′−Q
5がシーリング実行区間、また、教示位置区間Q1−Q
2,Q3−Q4が位置決め移動のためのシーリング非実
行区間である。シーリング非実行区間Q1−Q2および
Q3−Q4のビード幅に対応するシール剤圧力制御の目
標値は各々教示位置Q1およびQ3に対応してプログラ
ム設定され、また、シーリング実行区間Q2−Q3,Q
4−Q4′およびQ4′−Q5のビード幅に対応するシ
ール剤圧力制御の目標値は各々教示位置Q2,Q4およ
びQ4′に対応してプログラム設定されている。各シー
リング実行区間における圧力制御目標値は所望するビー
ド幅に対応して決められ、また、各シーリング非実行区
間の圧力制御目標値は次のシーリング実行区間で必要と
される初動圧力に対応して決められるものである。図5
ではシーリング実行区間Q2−Q3とQ4−Q4′のビ
ード幅が同じになるようにしているので、教示位置Q2
および教示位置Q4に対応してプログラム設定される目
標値は共に同じ値、例えば、Ps(c)である。よっ
て、シーリング実行区間Q2−Q3およびQ4−Q4′
におけるシーリング開始位置Q2,Q4で必要とされる
初動圧力が等しく、この結果、教示位置Q1に対応して
設定される圧力制御目標値および教示位置Q3に対応し
て設定される圧力制御目標値の値も、例えば、Ps
(a)と共に等しい。これに対し、シーリング実行区間
Q4′−Q5におけるビード幅はシーリング実行区間Q
2−Q3およびQ4−Q4′におけるビード幅に比べて
広くなるようにしているため、教示位置Q4′に対応し
て設定される圧力制御目標値、例えば、Ps(b)は、
教示位置Q2およびQ4に対応してプログラム設定され
る目標値Ps(c)に比べて大きい。FIG. 5 is a conceptual diagram showing an example of the correspondence between the teaching position of the moving route and the sealing execution section. In this example, the teaching position section Q2-Q3, Q4-Q4'-Q.
5 is the sealing execution section, and teaching position section Q1-Q
2, Q3 to Q4 are non-sealing sections for positioning movement. The target values of the sealing agent pressure control corresponding to the bead widths of the non-sealing sections Q1-Q2 and Q3-Q4 are programmed corresponding to the teaching positions Q1 and Q3, respectively, and the sealing execution sections Q2-Q3, Q
The target values of the sealant pressure control corresponding to the bead widths of 4-Q4 'and Q4'-Q5 are programmed corresponding to the teaching positions Q2, Q4 and Q4', respectively. The pressure control target value in each sealing execution section is determined according to the desired bead width, and the pressure control target value in each sealing non-execution section corresponds to the initial pressure required in the next sealing execution section. It can be decided. Figure 5
Since the bead widths of the sealing execution sections Q2-Q3 and Q4-Q4 'are the same, the teaching position Q2
The target value programmed corresponding to the teaching position Q4 is the same value, for example, Ps (c). Therefore, the sealing execution sections Q2-Q3 and Q4-Q4 '
Initial pressures required at the sealing start positions Q2 and Q4 are equal, and as a result, the pressure control target value set corresponding to the teaching position Q1 and the pressure control target value set corresponding to the teaching position Q3 are The value is, for example, Ps
Equal with (a). On the other hand, the bead width in the sealing execution section Q4'-Q5 is the sealing execution section Q.
Since the bead width at 2-Q3 and Q4-Q4 'is made wider, the pressure control target value set corresponding to the teaching position Q4', for example, Ps (b), is
It is larger than the target value Ps (c) which is programmed corresponding to the teaching positions Q2 and Q4.
【0028】このように、シーリング実行区間内でビー
ド幅を変更する場合においては、ビード幅の変更時にノ
ズルシャッタが閉鎖されることはないのでシール剤の供
給を停止した状態での加圧または減圧操作は当然不能と
なる。従って、シーリング区間内でビード幅を変更する
場合には、変更後のビード幅に対して必要とされる初動
圧力に関しては考慮せず、ビード幅の切替位置となる教
示位置に対応させてビード幅変更後の圧力制御目標値の
値を直接プログラム設定する。例えば、シーリング実行
区間Q4′−Q5のシーリング開始位置Q4′で必要と
される初動圧力に関しては無視し、教示位置Q4′には
シーリング実行区間Q4′−Q5のビード幅に対応する
圧力目標値Ps(b)をそのまま設定する。As described above, when changing the bead width within the sealing execution section, since the nozzle shutter is not closed when the bead width is changed, pressurization or depressurization with the supply of the sealant stopped. Operation is naturally impossible. Therefore, when changing the bead width within the sealing section, the initial dynamic pressure required for the changed bead width is not taken into consideration, and the bead width is changed according to the taught position that is the bead width switching position. Directly program the changed pressure control target value. For example, the initial dynamic pressure required at the sealing start position Q4 'of the sealing execution section Q4'-Q5 is ignored, and the teaching target position Q4' has a pressure target value Ps corresponding to the bead width of the sealing execution section Q4'-Q5. (B) is set as it is.
【0029】そして、運転開始指令を入力すると、プロ
セッサ11は所定周期毎教示プログラムを1ブロック毎
順次読取り、軸制御回路16を介してロボット本体20
の各軸のサーボモータを駆動制御してロボットを駆動
し、シールガンを教示経路に沿って移動させ、また、前
述したように、シールガン30bの現在位置が各教示位
置に到達する毎に、目標値となる圧力の値を順次RAM
13内の目標値記憶レジスタPsに更新記憶することに
なる。そして、教示プログラムよりシーリング開始指令
が読み込まれるとシールガン30bの電磁弁を作動させ
てノズルシャッタを開放し、また、シーリング終了指令
が読み込まれると上記電磁弁を非作動としてノズルシャ
ッタを閉鎖する。さらに、プロセッサ11は、所定周期
(例えば、ロボットの各軸へ移動指令を分配する分配周
期と同期した周期)毎、図3の処理を実行する。When the operation start command is input, the processor 11 sequentially reads the teaching program block by block at predetermined intervals, and the robot body 20 is read through the axis control circuit 16.
The servomotor for each axis is driven to drive the robot to move the seal gun along the teaching path, and, as described above, each time the current position of the seal gun 30b reaches each teaching position, a target value is set. RAM of the pressure values
It will be updated and stored in the target value storage register Ps in 13. When the sealing start command is read from the teaching program, the solenoid valve of the seal gun 30b is operated to open the nozzle shutter, and when the sealing end command is read, the solenoid valve is deactivated and the nozzle shutter is closed. Further, the processor 11 executes the process of FIG. 3 at a predetermined cycle (for example, a cycle synchronized with a distribution cycle for distributing a movement command to each axis of the robot).
【0030】プロセッサ11は、まず、圧力センサ40
からシール剤の現在圧力Pnを読取り(ステップb
1)、RAM13の目標値記憶レジスタに記憶された当
該シーリング実行区間もしくはシーリング非実行区間の
目標圧力値Psから該検出圧力Pnを減じ、更に、この
値に圧力制御のための設定比例ゲインk1を乗じてシー
ル剤供給ポンプのモータ30aの速度指令Vcを求め
(ステップb2)、該速度指令Vcを付加軸制御回路1
7に出力して(ステップb3)、シール剤供給ポンプの
モータ30aを駆動する。The processor 11 first detects the pressure sensor 40.
The current pressure Pn of the sealant is read from (step b
1), the detected pressure Pn is subtracted from the target pressure value Ps of the sealing execution section or the sealing non-execution section stored in the target value storage register of the RAM 13, and the set proportional gain k1 for pressure control is added to this value. The speed command Vc of the motor 30a of the sealant supply pump is obtained by multiplying (step b2), and the speed command Vc is added to the additional axis control circuit 1
7 (step b3) to drive the motor 30a of the sealant supply pump.
【0031】例えば、シールガン30bが現時点で図5
におけるシーリング非実行区間Q1−Q2上を移動して
いたとすれば、RAM13の目標値記憶レジスタから読
み込まれる目標圧力は教示位置Q1に対応する値、つま
り、次のシーリング実行区間の開始位置である教示位置
Q2で必要とされる初動圧力Ps(a)の値である。For example, the seal gun 30b is currently shown in FIG.
If it is moving on the sealing non-execution section Q1-Q2, the target pressure read from the target value storage register of the RAM 13 is the value corresponding to the teaching position Q1, that is, the teaching position that is the start position of the next sealing execution section. This is the value of the initial dynamic pressure Ps (a) required at the position Q2.
【0032】プロセッサ11は所定周期毎にステップb
1〜ステップb3の処理を繰り返し実行し、少なくとも
シールガン30bが教示位置Q2に到達するまでの間に
は、シール剤の現在圧力Pnを目標値Ps(a)に一致
させる。The processor 11 carries out step b every predetermined period.
The process from 1 to step b3 is repeatedly executed, and at least until the seal gun 30b reaches the taught position Q2, the current pressure Pn of the sealant is made to match the target value Ps (a).
【0033】そして、シールガン30bが次の教示位置
に到達して教示プログラムからシーリング開始指令が読
みこまれると、電磁弁が作動してノズルシャッタが開放
され、シールガン30bの移動経路はシーリング実行区
間Q2−Q3へと入り、RAM13の目標値記憶レジス
タの値は、教示位置Q2に対応する値、つまり、シーリ
ング実行区間Q2−Q3におけるビード幅に対応する圧
力値Ps(c)に書き替えられる。When the seal gun 30b reaches the next teaching position and the sealing start command is read from the teaching program, the solenoid valve is actuated to open the nozzle shutter and the movement path of the seal gun 30b is the sealing execution section Q2. -Entering Q3, the value of the target value storage register of the RAM 13 is rewritten to the value corresponding to the teaching position Q2, that is, the pressure value Ps (c) corresponding to the bead width in the sealing execution section Q2-Q3.
【0034】シーリング非実行区間Q1−Q2からシー
リング実行区間Q2−Q3へ移行する時の教示位置Q2
ではノズルシャッタが急激に開放されるため、シール剤
の現在圧力Pnが下降するが、教示位置Q1に対応して
設定された目標圧力Ps(a)はこのような圧力降下を
も考慮した教示位置Q2での初動圧力であるから、当該
シーリング実行区間におけるシーリング開始位置Q2で
不用意に圧力が降下してビード幅が減少することはな
い。プロセッサ11は、以下、書き替えられた目標値の
値Ps(c)に基いて所定周期毎に前記と同様の処理を
繰り返し実行し、シール剤の現在圧力Pnを目標圧力P
s(c)に安定的に保持して、該目標圧力Ps(c)に
対応するビード幅でシール剤を噴出させる。Teaching position Q2 when shifting from the non-sealing section Q1-Q2 to the sealing execution section Q2-Q3
In this case, since the nozzle shutter is suddenly opened, the current pressure Pn of the sealant drops, but the target pressure Ps (a) set corresponding to the teaching position Q1 is the teaching position in consideration of such pressure drop. Since it is the initial dynamic pressure at Q2, the bead width does not decrease due to an inadvertent pressure drop at the sealing start position Q2 in the sealing execution section. Hereinafter, the processor 11 repeatedly executes the same processing as described above every predetermined period based on the rewritten target value Ps (c) to set the current pressure Pn of the sealant to the target pressure Pn.
The sealing agent is stably held at s (c), and the sealing agent is jetted with a bead width corresponding to the target pressure Ps (c).
【0035】また、シールガン30bが次の教示位置Q
3に到達して教示プログラムからシーリング停止指令が
読みこまれると、ノズルシャッタが閉鎖され、シールガ
ン30bの移動経路はシーリング非実行区間Q3−Q4
へと入り、RAM13の目標値記憶レジスタの値は教示
位置Q3に対応する値、つまり、次のシーリング実行区
間Q4−Q4′における教示位置Q4で必要とされる初
動圧力の値Ps(a)に再び書き替えられる。シーリン
グ非実行区間Q3−Q4で生じる現象は前述したシーリ
ング非実行区間Q1−Q2の場合と同様である。Further, the seal gun 30b moves to the next teaching position Q.
3 is reached and the sealing stop command is read from the teaching program, the nozzle shutter is closed and the movement path of the seal gun 30b is the sealing non-execution section Q3-Q4.
Then, the value of the target value storage register of the RAM 13 becomes the value corresponding to the teaching position Q3, that is, the value Ps (a) of the initial pressure required at the teaching position Q4 in the next sealing execution section Q4-Q4 '. Will be rewritten again. The phenomenon occurring in the sealing non-execution section Q3-Q4 is the same as in the case of the sealing non-execution section Q1-Q2 described above.
【0036】そして、更に、シールガン30bが次の教
示位置Q4に到達して教示プログラムからシーリング開
始指令が読みこまれると、電磁弁が作動してノズルシャ
ッタが開放され、シールガン30bの移動経路はシーリ
ング実行区間Q4−Q4′へと入り、RAM13の目標
値記憶レジスタの値は、教示位置Q4に対応する値、つ
まり、シーリング実行区間Q4−Q4′におけるビード
幅に対応する圧力値Ps(c)に書き替えられる。シー
リング実行区間Q4−Q4′で生じる現象は前述したシ
ーリング実行区間Q2−Q3の場合と同様である。Further, when the seal gun 30b reaches the next teaching position Q4 and the sealing start command is read from the teaching program, the solenoid valve is actuated to open the nozzle shutter, and the movement path of the seal gun 30b is sealed. After entering the execution section Q4-Q4 ', the value of the target value storage register of the RAM 13 becomes the value corresponding to the teaching position Q4, that is, the pressure value Ps (c) corresponding to the bead width in the sealing execution section Q4-Q4'. Can be rewritten. The phenomenon occurring in the sealing execution section Q4-Q4 'is the same as in the case of the sealing execution section Q2-Q3 described above.
【0037】次いで、シールガン30bが次の教示位置
Q4′に到達してシールガン30bの移動経路がシーリ
ング実行区間Q4′−Q5へと入ると、RAM13の目
標値記憶レジスタの値は教示位置Q4′に対応する値、
つまり、シーリング実行区間Q4′−Q5におけるビー
ド幅に対応する圧力値Ps(b)に書き替えられる。Next, when the seal gun 30b reaches the next teaching position Q4 'and the movement path of the seal gun 30b enters the sealing execution section Q4'-Q5, the value of the target value storage register of the RAM 13 reaches the teaching position Q4'. The corresponding value,
That is, the pressure value Ps (b) corresponding to the bead width in the sealing execution section Q4'-Q5 is rewritten.
【0038】シーリング実行区間内における圧力目標値
の更新に際してはノズルシャッタの開放状態をそのまま
保持して圧力目標値の書き替えのみを行い、また、次の
シーリング実行区間の開始位置で必要とされる初動圧力
が予め印加されることもないので、現在圧力Pnは一次
の遅れを伴ってシーリング実行区間Q4−Q4′におけ
るビード幅に対応する圧力値Ps(c)からシーリング
実行区間Q4′−Q5におけるビード幅に対応する圧力
値Ps(b)へと徐々に変化する。つまり、この切り替
えにはノズルシャッタの開放動作が関与しないので、大
きな初動圧力を印加しなくても、例えば、教示位置Q
2,Q4等で心配されるような圧力降下が生じることは
なく、前述したように、現在圧力Pnは一次の遅れを伴
ってシーリング実行区間Q4−Q4′におけるビード幅
に対応する圧力値Ps(c)からシーリング実行区間Q
4′−Q5におけるビード幅に対応する圧力値Ps
(b)へと徐々に変化し、そのビード幅は、例えば図5
に示されるようにして徐々に増大し、現在圧力Pnがシ
ーリング実行区間Q4′−Q5におけるビード幅に対応
する圧力値Ps(b)に到達した時に、シーリング実行
区間Q4′−Q5のビード幅も安定する。When updating the target pressure value within the sealing execution section, the nozzle shutter is kept open and only the target pressure value is rewritten, and it is required at the start position of the next sealing execution section. Since the initial dynamic pressure is not applied in advance, the current pressure Pn is changed from the pressure value Ps (c) corresponding to the bead width in the sealing execution section Q4-Q4 'to the sealing execution section Q4'-Q5 with a primary delay. The pressure value Ps (b) corresponding to the bead width gradually changes. In other words, since the opening operation of the nozzle shutter does not participate in this switching, for example, the teaching position Q
There is no worrisome pressure drop at 2, Q4, etc., and as described above, the current pressure Pn is accompanied by a primary delay and the pressure value Ps (corresponding to the bead width in the sealing execution section Q4-Q4 '). From c) to the sealing execution section Q
Pressure value Ps corresponding to the bead width at 4'-Q5
It gradually changes to (b), and its bead width is, for example, as shown in FIG.
When the current pressure Pn reaches the pressure value Ps (b) corresponding to the bead width in the sealing execution section Q4'-Q5, the bead width in the sealing execution section Q4'-Q5 is also increased. Stabilize.
【0039】以下、プロセッサ11は、教示プログラム
の実行が完了するまでの間、ステップb1〜ステップb
3の圧力制御に関する処理を所定周期毎に繰り返し実施
し、シーリング非実行区間では各シーリング非実行区間
毎の目標圧力値の値に基いて次のシーリング実行区間の
開始位置で必要とされる初動圧力を得るための圧力制御
を行う一方、シーリング実行区間では、所望のビード幅
を得るための目標圧力値の値に基いて各シーリング実行
区間のビード幅を安定的に保持する。また、シーリング
実行区間内で目標圧力値の値が変更された場合には、ビ
ード幅を滑らかに変化させながらビード幅の異なる次の
シーリング実行区間へと移行することとなる。Thereafter, the processor 11 executes steps b1 to b until the execution of the teaching program is completed.
The process related to the pressure control of 3 is repeatedly performed every predetermined period, and in the sealing non-execution section, the initial pressure required at the start position of the next sealing execution section based on the target pressure value of each sealing non-execution section. While performing the pressure control to obtain the desired bead width, the bead width of each sealing execution period is stably maintained on the basis of the target pressure value for obtaining the desired bead width. Further, when the target pressure value is changed within the sealing execution section, the bead width is smoothly changed and the next sealing execution section having a different bead width is performed.
【0040】この結果、シーリング非実行区間からシー
リング実行区間へと移行する場合には、各シーリング実
行区間におけるビードの幅は各区間におけるシーリング
開始位置の近傍を含みその全てが安定し、例えば、図5
に示されるような正確なビード形状を得ることができ、
また、連続するシーリング実行区間内で目標圧力値を変
更させればビード幅を滑らかに変化させることができ
る。As a result, when the sealing non-execution section shifts to the sealing execution section, the width of the bead in each sealing execution section is stable, including the vicinity of the sealing start position in each section. 5
You can get the exact bead shape as shown in
Further, the bead width can be smoothly changed by changing the target pressure value within the continuous sealing execution section.
【0041】[0041]
【発明の効果】本発明によるシール剤の流量制御方法
は、棒状ノズルを備えたシールガンに対し、シール剤供
給ポンプのモータの回転速度を制御してシーリング実行
時におけるビードの膜厚を安定させると共に、シーリン
グの開始を待機するシーリング非実行時においては、シ
ール剤の圧力が設定圧力となるようにモータの駆動トル
クをフィードバック制御するようにしているので、シー
リング開始時点におけるシール剤の圧力を安定させるこ
とが可能となり、シーリング開始時点で生じるビード膜
厚の変動を未然に防止して、経路の全区間に亘り安定し
たビード膜厚でシーリング作業を行うことができる。ま
た、速度制御や圧力制御に用いられる比例ゲインや目標
値の値は教示位置に対応して教示プログラム中に設定す
るようにしているので、教示プログラムを操作すること
により、シーリング経路の教示位置毎ビードの膜厚を任
意に設定することができる。The method for controlling the flow rate of the sealant according to the present invention stabilizes the bead film thickness during sealing by controlling the rotation speed of the motor of the sealant supply pump for the seal gun having the rod-shaped nozzle. When the sealing is not executed waiting for the start of the sealing, the drive torque of the motor is feedback-controlled so that the pressure of the sealing agent becomes the set pressure, so that the pressure of the sealing agent is stabilized at the start of the sealing. This makes it possible to prevent fluctuations in the bead film thickness that occur at the start of sealing and to perform the sealing operation with a stable bead film thickness over the entire section of the path. Also, the proportional gain and target value used for speed control and pressure control are set in the teaching program in correspondence with the teaching position. The bead thickness can be set arbitrarily.
【0042】また、スプレーノズルを備えたシールガン
に対しては、シーリング実行時におけるシール剤の設定
圧力とシーリング非実行時におけるシール剤の設定圧力
とを区別してロボット制御装置に設定して圧力制御を行
うようにしているので、シーリング開始時点で生じるシ
ール剤の圧力降下を補償することが可能となり、シーリ
ング開始時点を含む全区間を通じて安定したビード幅を
得ることができる。また、圧力制御の目標値は教示位置
に対応して教示プログラム中に設定するようにしている
ので、教示プログラムを操作することにより、シーリン
グ経路の教示位置毎ビードの幅を任意に設定することが
できる。For a seal gun equipped with a spray nozzle, the set pressure of the sealant when the sealing is performed and the set pressure of the sealant when the sealing is not performed are set separately in the robot controller to control the pressure. Since this is done, it is possible to compensate for the pressure drop of the sealant that occurs at the start of sealing, and it is possible to obtain a stable bead width over the entire section including the start of sealing. Since the target value for pressure control is set in the teaching program corresponding to the teaching position, the width of the bead for each teaching position on the sealing path can be arbitrarily set by operating the teaching program. it can.
【図1】本発明の一実施例を実施するシーリングロボッ
トおよびロボット制御装置の要部を示すブロック図であ
る。FIG. 1 is a block diagram showing a main part of a sealing robot and a robot controller that implement an embodiment of the present invention.
【図2】棒状ノズルのシールガンを装着した状態で同実
施例のロボット制御装置が行う処理動作の要部を示すフ
ローチャートである。FIG. 2 is a flowchart showing a main part of a processing operation performed by the robot control apparatus of the embodiment with the stick gun of the rod-shaped nozzle attached.
【図3】スプレーノズルのシールガンを装着した状態で
同実施例のロボット制御装置が行う処理動作の要部を示
すフローチャートである。FIG. 3 is a flowchart showing a main part of a processing operation performed by the robot control apparatus of the embodiment with a spray gun seal gun attached.
【図4】棒状ノズルに関する移動経路の教示位置とシー
リング実行区間との対応関係の一例を示す概念図であ
る。FIG. 4 is a conceptual diagram showing an example of a correspondence relationship between a teaching position of a movement path regarding a rod-shaped nozzle and a sealing execution section.
【図5】スプレーノズルに関する移動経路の教示位置と
シーリング実行区間との対応関係の一例を示す概念図で
ある。FIG. 5 is a conceptual diagram showing an example of a correspondence relationship between a teaching position of a movement path regarding a spray nozzle and a sealing execution section.
【図6】棒状ノズルを備えたシールガンに関する従来の
制御方法の問題点を示す図である。FIG. 6 is a diagram showing a problem of a conventional control method regarding a seal gun having a rod-shaped nozzle.
【図7】スプレーノズルを備えたシールガンに関する従
来の制御方法の問題点を示す図である。FIG. 7 is a diagram showing a problem of a conventional control method regarding a seal gun having a spray nozzle.
10 ロボット制御装置 11 プロセッサ(CPU) 12 ROM 13 RAM 14 不揮発性メモリ 15 教示操作盤 16 軸制御回路 17 付加軸制御回路 18 入出力インターフェイス 20 ロボット本体 30a シール剤供給ポンプのモータ 30b シールガン 40 圧力センサ 10 Robot Control Device 11 Processor (CPU) 12 ROM 13 RAM 14 Nonvolatile Memory 15 Teaching Operation Panel 16 Axis Control Circuit 17 Additional Axis Control Circuit 18 I / O Interface 20 Robot Main Body 30a Sealant Supply Pump Motor 30b Seal Gun 40 Pressure Sensor
Claims (4)
ルガンをロボット手首に取付けシール剤の塗布をロボッ
トによって行う制御方法において、ロボット制御装置の
付加軸制御回路にシール剤供給ポンプを接続し、シーリ
ング実行時にはロボット制御装置によりロボットの移動
速度に所定の比例ゲインを乗じた速度指令で前記シール
剤供給ポンプのモータの回転速度を制御して該ロボット
に取り付けられたシールガンにシール剤を供給する一
方、シーリング非実行時にはシールガンに設けられた圧
力センサによりシール剤の圧力を検出し、該検出圧力が
設定圧力となるように前記モータの駆動トルクをフィー
ドバック制御するようにしたシーリングロボットにおけ
るシール剤の流量制御方法。1. In a control method in which a seal gun for applying a sealant with a rod-shaped nozzle is attached to a robot wrist and a sealant is applied by a robot, a sealant supply pump is connected to an additional axis control circuit of a robot controller to perform sealing. At the time of execution, the robot controller controls the rotation speed of the motor of the sealant supply pump by a speed command obtained by multiplying the moving speed of the robot by a predetermined proportional gain, and supplies the sealant to the seal gun attached to the robot. When the sealing is not executed, the pressure of the sealant is detected by the pressure sensor provided in the seal gun, and the drive torque of the motor is feedback-controlled so that the detected pressure becomes a set pressure. Method.
設定圧力をシーリング動作におけるロボット教示位置に
対応して教示プログラム中に設定するようにした請求項
1記載のシーリングロボットにおけるシール剤の流量制
御方法。2. The method for controlling the flow rate of a sealant in a sealing robot according to claim 1, wherein the predetermined proportional gain and the set pressure of the sealant are set in a teaching program in correspondence with a robot teaching position in a sealing operation. .
シールガンをロボット手首に取付けシール剤の塗布をロ
ボットによって行う制御方法において、ロボットに取り
付けられたシールガンにシール剤を供給するシール剤供
給ポンプをロボット制御装置の付加軸制御回路に接続す
ると共に、少なくとも、シーリング実行時におけるシー
ル剤の設定圧力とシーリング非実行時におけるシール剤
の設定圧力とを区別してロボット制御装置に設定し、シ
ールガンに設けられた圧力センサによりシール剤の圧力
を逐次検出して、該検出圧力が前記設定圧力となるよう
に前記シール剤供給ポンプのモータの駆動トルクをフィ
ードバック制御するようにしたシーリングロボットにお
けるシール剤の流量制御方法。3. In a control method in which a seal gun for applying a seal agent with a spray nozzle is attached to a robot wrist and a seal agent is applied by a robot, a robot is a seal agent supply pump for supplying the seal agent to the seal gun attached to the robot. In addition to being connected to the additional axis control circuit of the control device, at least the set pressure of the sealant when the sealing is executed and the set pressure of the sealant when the sealing is not executed are set in the robot controller and set in the seal gun. A method for controlling the flow rate of a sealant in a sealing robot, in which the pressure of the sealant is sequentially detected by a pressure sensor, and the driving torque of the motor of the sealant supply pump is feedback-controlled so that the detected pressure becomes the set pressure. .
おけるロボット教示位置に対応して教示プログラム中に
設定するようにした請求項3記載のシーリングロボット
におけるシール剤の流量制御方法。4. The method for controlling the flow rate of the sealant in a sealing robot according to claim 3, wherein the set pressure of the sealant is set in the teaching program in correspondence with the robot teaching position in the sealing operation.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP5096441A JPH06285402A (en) | 1993-04-01 | 1993-04-01 | Method of controlling rate of flow of sealing agent in sealing robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP5096441A JPH06285402A (en) | 1993-04-01 | 1993-04-01 | Method of controlling rate of flow of sealing agent in sealing robot |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH06285402A true JPH06285402A (en) | 1994-10-11 |
Family
ID=14165111
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP5096441A Pending JPH06285402A (en) | 1993-04-01 | 1993-04-01 | Method of controlling rate of flow of sealing agent in sealing robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH06285402A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010535629A (en) * | 2007-08-10 | 2010-11-25 | ファナック ロボティクス アメリカ,インコーポレイティド | Improved robot system and painting method for painting |
US10576628B2 (en) | 2017-06-07 | 2020-03-03 | Fanuc Corporation | Controller and machine learning device |
-
1993
- 1993-04-01 JP JP5096441A patent/JPH06285402A/en active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010535629A (en) * | 2007-08-10 | 2010-11-25 | ファナック ロボティクス アメリカ,インコーポレイティド | Improved robot system and painting method for painting |
US10576628B2 (en) | 2017-06-07 | 2020-03-03 | Fanuc Corporation | Controller and machine learning device |
DE102018004330B4 (en) * | 2017-06-07 | 2020-10-29 | Fanuc Corporation | Control and machine learning device |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6340875B1 (en) | Robot controller | |
US8783210B2 (en) | Robot coating system | |
EP0528047B1 (en) | Method of controlling flowrate of sealing material in sealing by industrial robot | |
KR100196750B1 (en) | Wire electric discharge machining method at a corner | |
CN111420819B (en) | Spraying operation control method and device | |
JP2006081955A (en) | Sealing system | |
JPH06285402A (en) | Method of controlling rate of flow of sealing agent in sealing robot | |
US5449875A (en) | Method of controlling spot welding robot | |
JP3376000B2 (en) | Control device and control method for sealing work robot | |
JPH05285434A (en) | Apparatus for discharging liquid | |
JP3105968B2 (en) | Paint flow control device | |
JP2002052484A (en) | Robot device and its control method | |
JP2809751B2 (en) | Paint gun discharge control system | |
JPH09201554A (en) | Method for controlling coating robot and apparatus therefor | |
JP4486222B2 (en) | Viscous material applicator | |
JP2976169B2 (en) | Coating equipment for viscous materials | |
JPH0596214A (en) | Controlling device for discharge of sealing compound | |
JP2600715B2 (en) | Robot servo control method | |
JP2007260531A (en) | Discharge paint control system in robot painting | |
JPH0560992B2 (en) | ||
JPH11188686A (en) | Robot controller | |
JP2003225877A (en) | Industrial robot | |
JPH0724386A (en) | Method and device for controlling coated pattern width of sealing agent | |
JP2006081954A (en) | Sealing controller | |
JPH07136558A (en) | Gun discharge amount control method and control device |