[go: up one dir, main page]

JPH0233454B2 - - Google Patents

Info

Publication number
JPH0233454B2
JPH0233454B2 JP57153662A JP15366282A JPH0233454B2 JP H0233454 B2 JPH0233454 B2 JP H0233454B2 JP 57153662 A JP57153662 A JP 57153662A JP 15366282 A JP15366282 A JP 15366282A JP H0233454 B2 JPH0233454 B2 JP H0233454B2
Authority
JP
Japan
Prior art keywords
conveyance
target position
transfer
point
signal
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
Application number
JP57153662A
Other languages
Japanese (ja)
Other versions
JPS5947184A (en
Inventor
Kenichi Teraoka
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Komatsu Ltd
Original Assignee
Komatsu Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Komatsu Ltd filed Critical Komatsu Ltd
Priority to JP57153662A priority Critical patent/JPS5947184A/en
Publication of JPS5947184A publication Critical patent/JPS5947184A/en
Publication of JPH0233454B2 publication Critical patent/JPH0233454B2/ja
Granted legal-status Critical Current

Links

Landscapes

  • Press Drives And Press Lines (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)
  • Reciprocating Conveyors (AREA)

Description

【発明の詳細な説明】 本発明は、複数の搬送軸を有する搬送装置に関
し、とくにはその位置決め手段に関する。
DETAILED DESCRIPTION OF THE INVENTION The present invention relates to a conveyance device having a plurality of conveyance axes, and particularly to a positioning means thereof.

複数の搬送軸を有する搬送装置として、たとえ
ばトランスフアプレス機のトランスフア装置があ
る。このトランスフア装置は、たとえば三次元方
式の場合、第1図に示すトランスフアバー1,1
を互いに近接するようにX軸方向にクランプ作動
させて、それらのトランスフアバーに設けたフイ
ンガー2によつて搬送物体たる被プレス材(図示
せず)を挾持させ、ついでZ軸方向にリフト作動
させたのちY軸方向にアドバンス作動させ、さら
にZ軸方向にダウン作動させたのちX軸方向にア
ンクランプ作動させて上記フインガー2で挾持し
ていた被プレス材を離し、しかるのちY軸方向に
リターンさせるという一連の搬送動作をプレス機
の作動に同期して行なう。
An example of a transfer device having a plurality of transfer shafts is a transfer device of a transfer press machine. For example, in the case of a three-dimensional system, this transfer device includes transfer bars 1 and 1 shown in FIG.
are clamped in the X-axis direction so as to bring them close to each other, and a material to be pressed (not shown), which is a conveyed object, is held between the fingers 2 provided on these transfer bars, and then lifted in the Z-axis direction. After that, it is operated in advance in the Y-axis direction, further in the down-movement in the Z-axis direction, and then unclamped in the X-axis direction to release the pressed material held by the fingers 2, and then returned in the Y-axis direction. A series of conveyance operations is performed in synchronization with the operation of the press machine.

ところで上記のように屈折した経路に従つて搬
送物体を搬送し位置決めする搬送手段は、必然的
に搬送経路が長くなる。
By the way, the conveying means that conveys and positions the conveyed object along the bent path as described above inevitably has a long conveying path.

そこで搬送のサイクルタイムを短縮するべく搬
送手段を2つまたは3つの搬送軸方向へ同時に起
動させることが考えられるが、かくすると次のよ
うな不都合を生じる。
Therefore, in order to shorten the cycle time of conveyance, it is considered to start the conveyance means in two or three conveyance axis directions at the same time, but this causes the following inconvenience.

すなわち、第2図に示すA点よりB点に向つて
物体を搬送する場合に、搬送手段を2つの搬送軸
方向に同時に移動させると、個々の搬送軸方向の
速度が変化する毎に同図に例示するように異なる
経路P,Q,Rを通ることになる。そのため搬送
経路によつては、搬送手段が搬送装置の他の部材
に接触するという問題を生じる。
In other words, when transporting an object from point A to point B shown in Figure 2, if the transport means is moved simultaneously in the directions of two transport axes, the speed in the direction of each transport axis changes each time the speed in the direction of each transport axis changes. As exemplified in , different routes P, Q, and R are taken. Therefore, depending on the conveying route, a problem arises in that the conveying means comes into contact with other members of the conveying device.

本発明の目的は、上記不都合を生じることなく
搬送のサイクルタイムを可及的に短縮することが
できるトランスフアプレス機の搬送装置を提供す
ることにある。
An object of the present invention is to provide a conveying device for a transfer press machine that can shorten the conveyance cycle time as much as possible without causing the above-mentioned disadvantages.

そのため本発明では、各別な位置決めサーボ系
によつて順次駆動される少なくとも2つの搬送軸
を有した搬送装置において、先に駆動される搬送
軸についてのサーボ系に目標位置指令を与える手
段と、上記目標位置指令に基づく目標位置よりも
所定距離手前の屈折点位置を上記目標位置と屈折
点位置間の位置偏差として指示する手段と、上記
先に駆動される搬送軸上における移動体の実際の
位置偏差が、上記指示された位置偏差に一致した
ことを検出する手段と、上記位置偏差の一致が検
出された際に、後に駆動される搬送軸についての
サーボ系に目標位置指令を与える手段とが備えら
れている。
Therefore, in the present invention, in a conveyance device having at least two conveyance axes sequentially driven by different positioning servo systems, means for giving a target position command to the servo system for the conveyance axis driven first; means for instructing a refraction point position a predetermined distance before the target position based on the target position command as a positional deviation between the target position and the refraction point position; means for detecting that the positional deviation matches the commanded positional deviation; and means for giving a target position command to a servo system for a conveyance axis to be driven later when the positional deviation matches the positional deviation. is provided.

以下、図示する実施例を参照しながら本発明を
詳細に説明する。
Hereinafter, the present invention will be explained in detail with reference to the illustrated embodiments.

第3図は、三次元トランスフアプレス機のトラ
ンスフア装置に適用した本発明の実施例を示す。
FIG. 3 shows an embodiment of the present invention applied to a transfer device of a three-dimensional transfer press machine.

同図に示すモータMX,MYおよびMZは、第1
図に示したトランスフアバー1,1をX軸、Y軸
およびZ軸方向に作動するものであり、これらの
モータは制御指令回路3より指令信号を受けるモ
ータ駆動回路4,5および6によつて駆動され
る。
The motors M X , M Y and M Z shown in the figure are the first
The transfer bars 1, 1 shown in the figure are operated in the X-axis, Y-axis, and Z-axis directions, and these motors are operated by motor drive circuits 4, 5, and 6 that receive command signals from a control command circuit 3. Driven.

モータ駆動回路4は、モータMXに連動するパ
ルス発生器(たとえばパルスエンコーダ)40の
出力パルスを計数するカウンタ41と、前記トラ
ンスフアバー1のX軸方向の移動量を示すこのカ
ウンタ41の計数値とラツチ回路42のラツチ内
容との偏差εXを出力する減算回路43と、D/A
変換器44で変換された上記偏差εXを入力してモ
ータMXを駆動する増幅器45とからなつている。
The motor drive circuit 4 includes a counter 41 that counts output pulses from a pulse generator (for example, a pulse encoder) 40 that is interlocked with the motor M and the latch contents of the latch circuit 42.
The amplifier 45 inputs the deviation ε X converted by the converter 44 to drive the motor M X.

なお増幅器45には、モータMXに連動する速
度発電器46の出力信号がフイードバツクされて
いる。
Note that the amplifier 45 is fed back with an output signal of a speed generator 46 that is interlocked with the motor MX .

他のモータ駆動回路5,6は、上記駆動回路4
と全く同様に構成されているのでその説明を省略
する。
The other motor drive circuits 5 and 6 are the drive circuit 4
Since the structure is exactly the same as that of , the explanation thereof will be omitted.

上記制御指令回路3は、これらの駆動回路4,
5および6を次のように制御する。すなわち、ま
ず第4図に示したP0点よりp1点まで第1図に示し
たトランスフアバー1を移動させる位置指令信号
S4a,P1点より所定距離P0点側に寄つたP′1(以
下、屈接点という)とP1点のなす距離(P1=P1
であることから、ここでは0)を示す信号S4cお
よびX軸を指定する信号S4dを第5図aに示すタ
イミングでラツチ回路42、比較回路48および
アンド回路49に加え、ついでラツチ信号S4bを
出力して上記信号S4aをラツチ回路42にラツチ
させる。
The control command circuit 3 includes these drive circuits 4,
5 and 6 are controlled as follows. That is, first, a position command signal to move the transfer bar 1 shown in FIG. 1 from the point P 0 shown in FIG. 4 to the point P 1 shown in FIG.
S 4 a, the distance between P′ 1 (hereinafter referred to as the bending contact point) , which is a predetermined distance closer to the P 0 point than the P 1 point, and the P 1 point (P 1 = P 1 )
Therefore, here, the signal S 4 c indicating 0) and the signal S 4 d specifying the X axis are applied to the latch circuit 42, the comparison circuit 48, and the AND circuit 49 at the timing shown in FIG. The signal S 4 b is output to cause the latch circuit 42 to latch the signal S 4 a.

この結果、上記位置指令信号Saが減算回路4
3に入力され、これによつて上記トランスフアバ
ー1が上記P0点からP1点に向つて移動を開始す
る。
As a result, the position command signal Sa is
3, thereby causing the transfer bar 1 to start moving from the P 0 point to the P 1 point.

上記モータMXの作動中において、上記指令回
路3は、第5図aに示すタイミングでリフト方向
P1〜P2についての位置指令信号S6a、第4図に示
す屈折点P′2よりP2点に到る距離P′2〜P2を示唆す
る信号S6cおよびZ軸を指定する信号S6dを各々
出力し、一方、比較回路48は上記偏差εXと信号
S4c(P1〜P′1=0)とを比較する。
While the motor M
Specify the position command signal S 6 a for P 1 to P 2 , the signal S 6 c indicating the distance P' 2 to P 2 from the refraction point P' 2 shown in Fig. 4, and the Z axis . On the other hand, the comparator circuit 48 outputs the signal S 6 d between the deviation ε
Compare S 4 c (P 1 to P′ 1 =0).

上記比較器48は、偏差εXが0つまりトランス
フアバー1がP1点に到達した時点で信号を出力
し、この信号はアンド回路49より信号S4eとし
て出力されたのち、オア回路7とオア回路47,
57および67を介してラツチ回路42,52お
よび62のラツチ信号入力端に加えられる。
The comparator 48 outputs a signal when the deviation ε OR circuit 47,
57 and 67 to the latch signal input terminals of latch circuits 42, 52 and 62.

このとき、ラツチ回路62には概に位置指令信
号S6aが与えられていることから、上記ラツチ信
号S4eが入力されると同時にモータMZが作動し、
これによつてトランスフアバーがP1点よりP2
に向つて移動される。
At this time, since the position command signal S 6 a is generally given to the latch circuit 62, the motor M Z operates at the same time as the latch signal S 4 e is input.
This moves the transfer bar from point P1 toward point P2 .

しかしてトランスフアバーがP1点よりP′2点ま
で移動される前に第5図aに示すタイミングでア
ドバンス方向P2〜P3についての位置指令信号
S5a、第4図に示す距離P′3〜P3を示唆する信号
S5cおよびY軸を指定する信号S5aが各々制御指
令回路3より出力され、かつ上記トランスフアバ
ーが屈接点P′2に到達した時点で比較回路68よ
り信号が出力される。そして比較回路68の出力
信号はアンド回路60よりS6eを出力させ、この
信号は概にラツチ回路52に加えられている上記
位置指令信号S5aを該回路にラツチさせるのでモ
ータMYが起動される。
Therefore, before the transfer bar is moved from point P1 to point P'2 , a position command signal in the advance direction P2 to P3 is sent at the timing shown in Figure 5a.
S 5 a, a signal suggesting the distance P′ 3 ~ P 3 shown in Fig. 4
A signal S 5 c and a signal S 5 a specifying the Y axis are outputted from the control command circuit 3, and a signal is outputted from the comparison circuit 68 when the transfer bar reaches the bending contact point P'2 . The output signal of the comparator circuit 68 causes the AND circuit 60 to output S 6 e, and this signal generally causes the position command signal S 5 a applied to the latch circuit 52 to be latched in this circuit, so that the motor M Y is will be activated.

この時点においてモータMZはまだ作動中であ
ることから、第5図dに示す期間T1だけモータ
MYと同時に作動され、その結果、トランスフア
バーは斜線で示す領域A内を通る態様で移動され
る。
Since the motor M Z is still operating at this point, the motor M Z remains active for the period T 1 shown in FIG. 5d.
M Y is actuated simultaneously, and as a result, the transfer bar is moved in a manner that passes through area A shown by diagonal lines.

以下、第5図aに示すタイミングで制御指令回
路より制御信号が出力され、かつ同図bに示す態
様でラツチ信号が順次出力されることから、屈折
点P3′よりモータMYとモータMZが、また屈折点
P5′よりモータMXとモータMYが各々同時に作動
され、それによつてトランスフアバーは斜線領域
BおよびC内を通つて移動される。
Thereafter, the control signal is outputted from the control command circuit at the timing shown in FIG. 5a , and the latch signal is sequentially outputted in the manner shown in FIG . Z is also the point of refraction
From P 5 ' , motor M

上記実施例では、クランプ作動からリフト作動
に移行する部分およびダウン作動からアンクラン
プ作動に移行する部分においてトランスフアバー
の2軸同時移動を行なつていないが、これはクラ
ンプおよびアンクランプ動作を確実に行なうため
である。もちろんP1,P4点部分で2軸同時移動
を行なわせることも可能であり、かかる場合に
は、リターンおよびアドバンス作動時に第3図に
示す信号S4cおよびS6cを所定の有限値に設定すれ
ばよい。また上記領域A,BおよびCの広さは、
屈折点P′2点、P′3点およびP′5点の位置を変える
ことにより変化され、一方、上記各領域内におけ
るトランスフアバーの移動軌跡は、各軸方向につ
いての移動速度によつて変化される。なお、回路
3の各出力信号は、プレスの作動角θに同期して
出力される。
In the above embodiment, the transfer bar is not moved in two axes simultaneously in the transition from clamp operation to lift operation and the transition from down operation to unclamp operation, but this ensures reliable clamping and unclamping operations. It is for the purpose of doing. Of course, it is also possible to simultaneously move two axes at the four points P 1 and P. In such a case, the signals S 4 c and S 6 c shown in FIG. 3 should be set to predetermined finite values during return and advance operations. You can set it to . Furthermore, the widths of the above areas A, B and C are
It is changed by changing the positions of the refraction points P′ 2 , P′ 3 , and P′ 5. On the other hand, the movement locus of the transfer bar within each of the above regions changes depending on the movement speed in each axial direction. be done. Note that each output signal of the circuit 3 is output in synchronization with the operating angle θ of the press.

上記するように本発明による方法は、搬送方向
の転換部のみにおいて搬送手段を2軸方向に同時
に作動させるようにしているので、上記搬送手段
を他物体に接触させることなく搬送位置決めのサ
イクルタイムを短縮することができる。
As described above, in the method according to the present invention, the conveyance means is simultaneously operated in two axes only at the conveyance direction switching section, so that the cycle time for conveyance positioning can be reduced without bringing the conveyance means into contact with other objects. Can be shortened.

また本発明では、屈折点位置を目標位置と該屈
折点位置間の位置偏差として指示し、移動体の実
際の位置偏差が上記指示された位置偏差に一致し
た際に、後に駆動される搬送軸についてのサーボ
系に目標位置指令を与えるようにしている。
Further, in the present invention, the refraction point position is specified as a positional deviation between the target position and the refraction point position, and when the actual positional deviation of the moving body matches the specified positional deviation, the conveyance shaft that is subsequently driven A target position command is given to the servo system.

各搬送軸についてのサーボ系には、位置偏差を
検出する手段が設けられるので、位置偏差に基づ
いて屈折点位置を判定するようにした本発明によ
れば、従来のサーボ系の機能を利用して屈折点位
置を容易に検出することができる。
Since the servo system for each conveyance axis is provided with a means for detecting positional deviation, the present invention, which determines the bending point position based on the positional deviation, utilizes the functions of the conventional servo system. The position of the refraction point can be easily detected.

更に本発明によれば、屈折点の変更が可能であ
るから、搬送機構の動特性に最適な屈折点を容易
に設定することができる。
Further, according to the present invention, since the refraction point can be changed, it is possible to easily set the refraction point that is optimal for the dynamic characteristics of the transport mechanism.

もちろん本発明は、プレス機のトランスフア装
置だけでなく他の搬送装置、たとえばロボツトア
ームの位置決め等にも有効に適用することができ
る。また2次元の搬送軸をもつ搬送装置にも適用
しうる。
Of course, the present invention can be effectively applied not only to the transfer device of a press machine but also to other transfer devices, such as the positioning of a robot arm. It can also be applied to a conveyance device having a two-dimensional conveyance axis.

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

第1図はトランスフアプレス機のトランスフア
バーの作動態様を概念的に示した斜視図、第2図
は2次元の搬送装置において搬送手段を各軸方向
に同時に作動した場合における該搬送手段の移動
軌跡を示した図、第3図は本発明を適用したトラ
ンスフアプレス機の制御回路の一例を示したブロ
ツク図、第4図は三次元トランスフアプレス機の
トランスフアバーを本発明に従つて作動させた場
合の作動軌跡を例示した図、第5図a〜eは第3
図の回路の作用を示すタイミングチヤートであ
る。 1……トランスフアバー、3……制御指令回
路、4,5,6……モータ駆動回路、MX,MY
MZ……モータ。
Fig. 1 is a perspective view conceptually showing the operation mode of the transfer bar of the transfer press machine, and Fig. 2 is the movement of the transfer means when the transfer means are simultaneously operated in each axis direction in a two-dimensional transfer device. FIG. 3 is a block diagram showing an example of a control circuit of a transfer press machine to which the present invention is applied; FIG. 4 is a diagram showing a transfer bar of a three-dimensional transfer press machine operated according to the present invention. Figures 5a to 5e are diagrams illustrating the operating trajectory when the
3 is a timing chart showing the operation of the circuit shown in the figure. 1... Transfer bar, 3... Control command circuit, 4, 5, 6... Motor drive circuit, M X , M Y ,
MZ ...Motor.

Claims (1)

【特許請求の範囲】 1 各別な位置決めサーボ系によつて順次駆動さ
れる少なくとも2つの搬送軸を有した搬送装置に
おいて、 先に駆動される搬送軸についてのサーボ系に目
標位置指令を与える手段と、 上記目標位置指令に基づく目標位置よりも所定
距離手前の屈折点位置を上記目標位置と屈折点位
置間の位置偏差として指示する手段と、 上記先に駆動される搬送軸上における移動体の
実際の位置偏差が、上記指示された位置偏差に一
致したことを検出する手段と、 上記位置偏差の一致が検出された際に、後に駆
動される搬送軸についてのサーボ系に目標位置指
令を与える手段と を備えてなるトランスフアプレス機の搬送装置。
[Claims] 1. In a conveyance device having at least two conveyance axes sequentially driven by different positioning servo systems, means for giving a target position command to the servo system for the conveyance axis driven first. and means for instructing a refraction point position a predetermined distance before the target position based on the target position command as a positional deviation between the target position and the refraction point position; means for detecting that the actual positional deviation matches the instructed positional deviation; and when the coincidence of the positional deviations is detected, giving a target position command to the servo system for the transport axis that will be driven later; A transfer device for a transfer press machine, comprising means.
JP57153662A 1982-09-03 1982-09-03 Method of positioning conveyor Granted JPS5947184A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP57153662A JPS5947184A (en) 1982-09-03 1982-09-03 Method of positioning conveyor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP57153662A JPS5947184A (en) 1982-09-03 1982-09-03 Method of positioning conveyor

Publications (2)

Publication Number Publication Date
JPS5947184A JPS5947184A (en) 1984-03-16
JPH0233454B2 true JPH0233454B2 (en) 1990-07-27

Family

ID=15567436

Family Applications (1)

Application Number Title Priority Date Filing Date
JP57153662A Granted JPS5947184A (en) 1982-09-03 1982-09-03 Method of positioning conveyor

Country Status (1)

Country Link
JP (1) JPS5947184A (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0761806B2 (en) * 1989-03-29 1995-07-05 グンゼ株式会社 Container carrier
JP2782491B2 (en) * 1992-10-16 1998-07-30 株式会社牧野フライス製作所 Method and apparatus for controlling rapid traverse of machine tools

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5747123U (en) * 1980-08-30 1982-03-16

Also Published As

Publication number Publication date
JPS5947184A (en) 1984-03-16

Similar Documents

Publication Publication Date Title
JP3702257B2 (en) Robot handling device
JP3002097B2 (en) Visual tracking method
EP0067877A1 (en) Robot control system
US4626756A (en) Numerical control system
JP2524931B2 (en) Robot linear interpolation method
US4562551A (en) Robot control system
JPH0150490B2 (en)
JPH0810409B2 (en) Servo motor system for transportation
WO1989006066A1 (en) Method of speed control for servomotor
JPH0233454B2 (en)
JP2003044144A (en) Device, method, and program for multiaxial synchronous control
JP2960292B2 (en) Multifunctional robot
JPS59200304A (en) Control method of industrial robot
JP2633696B2 (en) Robot control system
JPH06179099A (en) Method and device for controlling transfer press
JP2667080B2 (en) Transfer control device
JP4096169B2 (en) Linear motor continuous transfer device
JP3598262B2 (en) Multifunctional robot
JP3698479B2 (en) Automatic motion recovery device
JPS63109510A (en) Control method for automatic palletizer
JPH0460749B2 (en)
JPH01220009A (en) Controller for carryier car
JPH11191011A (en) Robot control unit and its control method
JPH01318101A (en) Method and device for multiaxis control
JPH06131022A (en) Control method and device for component mounting device