JPH0455817B2 - - Google Patents

Info

Publication number
JPH0455817B2
JPH0455817B2 JP57215131A JP21513182A JPH0455817B2 JP H0455817 B2 JPH0455817 B2 JP H0455817B2 JP 57215131 A JP57215131 A JP 57215131A JP 21513182 A JP21513182 A JP 21513182A JP H0455817 B2 JPH0455817 B2 JP H0455817B2
Authority
JP
Japan
Prior art keywords
hand
workpiece
recharging
chuck
memory
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
JP57215131A
Other languages
Japanese (ja)
Other versions
JPS59107838A (en
Inventor
Munetada Kurita
Tomio Murase
Kazuya Nishimura
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.)
Yamazaki Mazak Corp
Original Assignee
Yamazaki Mazak Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yamazaki Mazak Corp filed Critical Yamazaki Mazak Corp
Priority to JP57215131A priority Critical patent/JPS59107838A/en
Publication of JPS59107838A publication Critical patent/JPS59107838A/en
Publication of JPH0455817B2 publication Critical patent/JPH0455817B2/ja
Granted legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/418Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS], computer integrated manufacturing [CIM]
    • G05B19/41815Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS], computer integrated manufacturing [CIM] characterised by the cooperation between machine tools, manipulators and conveyor or other workpiece supply system, workcell
    • G05B19/41825Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS], computer integrated manufacturing [CIM] characterised by the cooperation between machine tools, manipulators and conveyor or other workpiece supply system, workcell machine tools and manipulators only, machining centre
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Description

【発明の詳細な説明】 本発明は、工作機械にワークを搬入・搬出する
ハンドリングロボツトに関する。
DETAILED DESCRIPTION OF THE INVENTION The present invention relates to a handling robot that carries a workpiece into and out of a machine tool.

最近、工作機械に対するワークの搬入・搬出を
ハンドリングロボツトを用いて自動的に行なわ
せ、効率的な加工作業を行なわせようとする提案
がなされている。こうした提案を効果的に実現す
るためには、ワークの搬入・搬出時にロボツトが
行なうべき動作をロボツトに指令するテイーチン
グ作業を、いかに簡単にかつ短時間で行なうかが
解決すべき重要な問題となる。
Recently, proposals have been made to use handling robots to automatically load and unload workpieces into and out of machine tools, thereby enabling efficient machining operations. In order to effectively realize these proposals, an important problem to be solved is how to easily and quickly perform the teaching task of instructing the robot on the actions it should perform when loading and unloading workpieces. .

従来、ハンドリングロボツトに対するテイーチ
ングは、オペレータがハンドリングに必要な動作
を、ロボツトの動作を構成する最低の動作単位で
ある動作ステツプに分解し、それ等動作ステツプ
に対応する動作指令を実際に実行すべき順に手動
でキーボード等から指令してメモリに格納してお
く方法が採られており、実行時にはメモリ中に格
納された動作指令を順次読み出し実行することに
より所定の動作を行なわせていた。
Traditionally, teaching for handling robots involves the operator breaking down the movements necessary for handling into movement steps, which are the lowest movement units that make up the robot's movement, and actually executing the movement commands corresponding to those movement steps. A method has been adopted in which commands are manually given from a keyboard or the like and stored in a memory, and when executed, a predetermined action is performed by sequentially reading and executing the action commands stored in the memory.

しかし、こうした方法は、動作ステツプ毎でし
か指令を与えることができないためにロボツトに
入力すべき動作指令が極めて多くなり、テイーチ
ングに多くの時間を要すばかりか、オペレータが
ロボツトの取り得る全ての動作ステツプを熟知し
ている必要があり、高度の知識と熟練を要した。
However, with these methods, since commands can only be given for each movement step, the number of movement commands that must be input to the robot is extremely large, which not only requires a lot of time for teaching, but also allows the operator to perform all the possible actions of the robot. It required a thorough knowledge of the movement steps, requiring a high degree of knowledge and skill.

本発明は、前述の欠点を解消すべく、リチヤツ
キング動作を、動作ステツプ毎にいちいち指令す
るテイーチングを行なうことなく、簡単に指示し
得る、従つてテイーチング時間が短かくて済むハ
ンドリングロボツトを提供することを目的とする
ものである。
SUMMARY OF THE INVENTION In order to solve the above-mentioned drawbacks, the present invention provides a handling robot that can easily instruct a recharging operation without having to perform teaching to instruct the recharging operation for each operation step, and therefore requires a short teaching time. The purpose is to

即ち、本発明は、2個以上の動作ステツプから
構成される、リチヤツキング動作ルーチンを選択
的に実行可能なるように構成した動作プログラム
を格納したメモリ、及び前記リチヤツキング動作
ルーチンの選択を指示するルーチン指示手段を設
け、前記指示手段を操作することにより、リチヤ
ツキング動作の実行を指示し得るようにして構成
される。
That is, the present invention provides a memory storing an operation program configured to be able to selectively execute a recharging operation routine consisting of two or more operation steps, and a routine instruction for instructing selection of the recharging operation routine. A device is provided, and by operating the instruction device, it is possible to instruct execution of a recharging operation.

以下、図面に基き、本発明の実施例を説明す
る。
Embodiments of the present invention will be described below based on the drawings.

第1図は本発明の一実施例であるハンドリング
ロボツトを数値制御旋盤に装着した際の一例を示
す斜視図、第2図はダブルハンドを示す図で、a
は外締め用、bは内締め用、第3図はシングルハ
ンドを示す斜視図、第4図は第1図のハンドリン
グロボツトの制御ブロツク図、第5図はダブルハ
ンド動作プログラムの一例を示すフローチヤー
ト、第6図はシングルハンド動作プログラムの一
例を示すフローチヤート、第7図は内締め把持動
作サブルーチンの一例を示すフローチヤート、第
8図は外締め把持動作サブルーチンの一例を示す
フローチヤート、第9図はリチヤツキング動作サ
ブルーチンの一例を示すフローチヤート、第10
図は機械外反転動作サブルーチンの一例を示すフ
ローチヤート、第11図はダブルハンドの第5図
に示す動作プログラムに基く動作態様を示す図、
第12図はシングルハンドの第6図に示す動作プ
ログラムに基く動作態様を示す図、第13図はハ
ンド、ワーク、コンベアユニツトのパレツト及び
数値制御旋盤のチヤツク間の寸法関係を示す図、
第14図はダブルハンドを用いた際の、加工中に
おける各部の状態を示す図、第15図はシングル
ハンドを用いた際の、加工中における各部の状態
を示す図、第16図は各動作ステツプに対応する
表示パターンの、デイスプレイ上での表示の一例
を示す図である。
Fig. 1 is a perspective view showing an example of a handling robot according to an embodiment of the present invention mounted on a numerically controlled lathe, and Fig. 2 is a diagram showing a double hand.
3 is a perspective view showing a single hand, FIG. 4 is a control block diagram of the handling robot shown in FIG. 1, and FIG. 5 is a flowchart showing an example of a double hand operation program. 6 is a flowchart showing an example of a single hand operation program, FIG. 7 is a flowchart showing an example of an inner tightening gripping operation subroutine, and FIG. 8 is a flowchart showing an example of an outer tightening gripping operation subroutine. FIG. 9 is a flowchart showing an example of the recharging operation subroutine, No. 10.
FIG. 11 is a flowchart showing an example of a subroutine for reversing the outside of the machine; FIG. 11 is a diagram showing an operation mode based on the operation program shown in FIG. 5 for double hands;
FIG. 12 is a diagram showing the operation mode based on the operation program shown in FIG. 6 for a single hand, and FIG. 13 is a diagram showing the dimensional relationship between the hand, workpiece, pallet of the conveyor unit, and chuck of the numerically controlled lathe.
Figure 14 is a diagram showing the state of each part during machining when using a double hand, Figure 15 is a diagram showing the state of each part during machining when using a single hand, and Figure 16 is a diagram showing each operation. FIG. 6 is a diagram showing an example of a display pattern corresponding to a step on a display.

ハンドリングロボツト1は、第1図に示すよう
に、数値制御旋盤2の前面に本体3が、矢印A、
B方向に約90°の範囲で回動自在に設けられてお
り、本体3にはメインアーム5が矢印E、F方向
に回動及び矢印C、D方向に伸縮自在に設けられ
ている。メインアーム5にはサブアーム6が矢印
G、H方向に回動自在に設けられており、サブア
ーム6にはハンド7が着脱交換自在に設けられて
いる。ハンド7には、第2図に示すように、保持
爪7a,7aからなる保持部7bがハンド7の両
側に設けられた軽荷物用のダブルハンドと、第3
図に示すように、保持部7bが一個だけ設けられ
た重荷重用のシングルハンドとが有り、両者は共
にサブアーム6に対して自由に脱着することがで
きる。ダブルハンドのハンド7は、第2図に示す
ように、サブアーム6に装着されるアンローデイ
ングハンド7cを有しており、アンローデイング
ハンド7cには保持爪7a,7aが矢印H、I方
向に開閉自在に設けられている。アンローデイン
グハンド7cにはアーム7dが設けられており、
アーム7dにはシヤフト7i,7iが設けられて
いる。シヤフト7i,7iにはローデイングハン
ド7eがアーム7fを介して矢印J、K方向に移
動自在に支持されており、アーム7d,7f間に
はコイルばね7h,7hがシヤフト7i,7iを
被覆する形で縮設され、ばね7hはローデイング
ハンド7eを常時矢印J方向に付勢している。ま
た、ローデイングハンド7eには保持爪7a,7
aが矢印H、I方向に開閉自在に設けられてお
り、保持爪7a,7aを開閉することによりワー
ク26の把持動作を行なうことができる(アンロ
ーデイングハンド7cの保持爪7a,7aについ
ても同様。)一方、シングルハンドは、第3図に
示すように、本体7jに3個の保持爪7aが放射
状に開閉自在に設けられており、保持爪7aを開
閉することによりワーク26の把持動作を行なう
ことができる。
As shown in FIG. 1, the handling robot 1 has a main body 3 on the front side of a numerically controlled lathe 2, with arrows A,
The main arm 5 is provided on the main body 3 so as to be rotatable in the directions of arrows E and F and to be extendable and retractable in the directions of arrows C and D. A sub-arm 6 is provided on the main arm 5 so as to be rotatable in the directions of arrows G and H, and a hand 7 is provided on the sub-arm 6 so as to be detachable and replaceable. As shown in FIG. 2, the hand 7 includes a double hand for carrying light loads, in which a holding part 7b consisting of holding claws 7a and 7a is provided on both sides of the hand 7, and a third hand.
As shown in the figure, there is a single hand for heavy loads in which only one holding portion 7b is provided, and both can be freely attached to and removed from the sub-arm 6. As shown in FIG. 2, the double-handed hand 7 has an unloading hand 7c attached to the sub-arm 6, and the unloading hand 7c has holding claws 7a that open and close in the directions of arrows H and I. It is set freely. The unloading hand 7c is provided with an arm 7d,
The arm 7d is provided with shafts 7i, 7i. A loading hand 7e is supported on the shafts 7i, 7i so as to be movable in the directions of arrows J and K via an arm 7f, and coil springs 7h, 7h cover the shafts 7i, 7i between the arms 7d, 7f. The spring 7h constantly urges the loading hand 7e in the direction of arrow J. Further, the loading hand 7e has holding claws 7a, 7.
a is provided so as to be openable and closable in the directions of arrows H and I, and the workpiece 26 can be gripped by opening and closing the holding claws 7a and 7a (the same applies to the holding claws 7a and 7a of the unloading hand 7c). ) On the other hand, as shown in FIG. 3, in the single hand, three holding claws 7a are provided on the main body 7j in a radial manner that can be freely opened and closed, and the gripping operation of the workpiece 26 is controlled by opening and closing the holding claws 7a. can be done.

一方、本体3の第1図左方には、ハンドリング
ロボツト1を構成するコンベアユニツト9が設置
されており、コンベアユニツト9には多数のパレ
ツト9aが移動自在に設けられている。また、数
値制御旋盤2には回転駆動自在なチヤツク2aが
主軸に装着された形で設けられており、更にドア
2bが機体2d上方に設けられたエアシリンダ2
eによつて矢印K、L方向に開閉自在に設けられ
ている。
On the other hand, a conveyor unit 9 constituting the handling robot 1 is installed on the left side of the main body 3 in FIG. 1, and a large number of pallets 9a are movably provided on the conveyor unit 9. In addition, the numerically controlled lathe 2 is provided with a chuck 2a that can be freely rotated and mounted on the main shaft, and a door 2b is installed on an air cylinder 2 provided above the machine body 2d.
It is provided so as to be openable and closable in the directions of arrows K and L as indicated by e.

また、ハンドリングロボツト1は、第4図に示
すように、主制御部10を有しており、主制御部
10には駆動制御部11、教示データメモリ1
2、キーボード13、表示制御部15、動作プロ
グラムメモリ16、固有動作メモリ17、軸移動
量メモリ20等がバス線14を介して接続してい
る。駆動制御部11には、ロボツト1に種々の動
作を行なわせるための駆動源として多数のアクチ
エータ21が接続しており、表示制御部15には
動作名称メモリ23及びデイスプレイ25が接続
している。
The handling robot 1 also has a main control section 10, as shown in FIG. 4, and the main control section 10 includes a drive control section 11 and a teaching data memory 1.
2, a keyboard 13, a display control unit 15, an operation program memory 16, a specific operation memory 17, an axis movement amount memory 20, etc. are connected via a bus line 14. A large number of actuators 21 are connected to the drive control section 11 as drive sources for causing the robot 1 to perform various operations, and an operation name memory 23 and a display 25 are connected to the display control section 15.

ハンドリングロボツト1は、以上のような構成
を有するので、ロボツト1に数値制御旋盤2に対
するワークの搬入・搬出を行なわせるためには、
オペレータはキーボード13上に設けられた、キ
ー13aのうち、ハンド指定キー13e、把持動
作指定キー13b、リチヤツキング指定キー13
c、反転指定キー13dを操作してハンドの種
類、ワークの把持態様、リチヤツキングの有無、
ダブルハンドの場合のワーク反転位置を入力す
る。即ち、ハンド指定キー13eを押下した場合
には、サブアーム6に装着されたハンドは保持部
7bが1個のシングルハンドであり、キー13e
を押下しない場合にはダブルハンドである。ま
た、保持動作指定キー13bを押下した場合に
は、ワークを把持する際に、ワーク内径側から把
持する内締め把持であり、押下しない場合には、
ワークを外径側から把持する外締め把持である。
更に、リチヤツキング指令キー13cを押下した
場合には、ワークをチヤツキングする際にリチヤ
ツキングを行ない、押下しない場合にはリチヤツ
キングは行なわない。また、反転指定キー13b
を押下した場合には、ワーク反転位置が機械外に
指定され、押下しない場合には、機械内の反転動
作となる。こうしてキーボード13から入力され
るデータは全て教示データTDTとして教示デー
タメモリ12中に格納される。オペレータは更
に、加工すべきワークの数、ワークの加工前、加
工後における把持装置g,g′、及びワーク全長l
(第13図b,c,g参照)をキーボード13か
ら入力し、教示データTDTとして教示データメ
モリ12中に格納する。これ等の教示データ
TDTの入力、即ちテイーチングが完了したとこ
ろで、オペレータはコンベアユニツト9の各パレ
ツト9a上に、第14図及び第15図に示すよう
に、加工すべき未加工のワーク26を搭載し、キ
ーボード13上の実行キー13fを押下する。
Since the handling robot 1 has the above configuration, in order to have the robot 1 load and unload workpieces into and out of the numerically controlled lathe 2,
Of the keys 13a provided on the keyboard 13, the operator selects a hand designation key 13e, a grasping motion designation key 13b, and a recharging designation key 13.
c. Operate the reversal designation key 13d to select the type of hand, gripping mode of the workpiece, whether or not to recharge,
Enter the workpiece reversal position for double hand. That is, when the hand designation key 13e is pressed, the hand attached to the sub-arm 6 is a single hand with one holding part 7b, and the hand specified by the key 13e is
If you do not press , it is double handed. Furthermore, when the holding operation designation key 13b is pressed, when gripping the workpiece, the gripping is performed from the inner diameter side of the workpiece, and when the holding operation designation key 13b is not pressed,
This is an external clamping grip in which the workpiece is gripped from the outside diameter side.
Further, when the recharging command key 13c is pressed, recharging is performed when chucking the workpiece, and when the recharging command key 13c is not pressed, no recharging is performed. In addition, the reverse designation key 13b
If the button is pressed, the workpiece reversal position is specified outside the machine, and if it is not pressed, the workpiece is reversed inside the machine. In this way, all data input from the keyboard 13 is stored in the teaching data memory 12 as teaching data TDT. The operator further determines the number of workpieces to be machined, the gripping devices g, g′ before and after machining the workpieces, and the total length of the workpieces l.
(See FIGS. 13b, c, and g) is input from the keyboard 13 and stored in the teaching data memory 12 as teaching data TDT. These teaching data
When inputting the TDT, that is, teaching, is completed, the operator places the unprocessed workpieces 26 to be processed on each pallet 9a of the conveyor unit 9, as shown in FIGS. Press the execution key 13f.

これにより、主制御部10は直ちに教示データ
メモリ12中の教示データTDTを検索し、まず
サブアーム6に装着されたハンド7がダブルハン
ドからシングルハンドかを読み出し、動作プログ
ラムメモリ16からハンドの種類に対応した動作
プログラムAPROを読み出し、当該動作プログ
ラムAPROに基いて駆動制御部11を介して各
アクチユエータ21を駆動制御する。
As a result, the main control unit 10 immediately searches the teaching data TDT in the teaching data memory 12, first reads whether the hand 7 attached to the sub-arm 6 is a double hand or a single hand, and then inputs the type of hand from the operation program memory 16. The corresponding operation program APRO is read out, and each actuator 21 is drive-controlled via the drive control section 11 based on the operation program APRO.

即ち、動作プログラムメモリ16には、ダブル
ハンド動作プログラムDHPとシングルハンド動
作プログラムSHSが動作プログラムAPROとし
て格納されている。まず、ダブルハンド動作プロ
グラムDHPについて説明すると、プログラム
DHPは、第5図及び第11図に示すように、動
作ステツプS1,S2で本体3を第1図B方向に
ボデイアツプさせ、メインアーム5をD方向に突
出させて、メインアーム5を原点ZPに復帰させ
る。この際の、コンベアユニツト9のパレツト9
aと、数値制御旋盤2のチヤツク2aとハンド7
の寸法関係を、第13図aに示すように定義す
る。即ち、CHHはチヤツク2aからハンド7迄
の距離であり、CHはチヤツク2aの爪2fの高
さであり、COHは、メインアーム5を原点ZPに
保持した状態で、本体3をA方向にボデイダウン
させた際(第13図aにおいて想像線で示す。)
の、パレツト9aからハンド7迄の距離である。
次に、ステツプS3で、メインアーム5を第1図
C方向に移動させ(以下、メインアーム5のC、
D方向の移動を「軸移動」と称する。)、ハンド7
を、第13図bで示すように、 1D=COH−l ……(1) l:オペレータが入力したワーク全長 だけ原点ZPからC方向に寄つた位置に位置決め
する。次に、ステツプS4でA方向にボデイダウ
ンさせ、ステツプS5で、サブアーム6を回転さ
せてローデイングハンド(フローチヤート中「(L)
ハンド」と表示)7eをパレツト9a方向に向け
る。ステツプS6では、教示データメモリ12を
検索し、オペレータが教示データTDTにおいて
内締め把持を指定した場合には、内締め把持動作
サブルーチンSUB1に入り、外締め把持を指定
した場合には、外締め把持動作サブルーチン
SUB2に入る。
That is, the operation program memory 16 stores a double hand operation program DHP and a single hand operation program SHS as an operation program APRO. First, to explain the double hand operation program DHP, the program
As shown in FIGS. 5 and 11, in operation steps S1 and S2, the DHP raises the main body 3 in the direction B in FIG. to be restored. At this time, pallet 9 of conveyor unit 9
a, chuck 2a and hand 7 of numerically controlled lathe 2
The dimensional relationship is defined as shown in FIG. 13a. That is, CHH is the distance from the chuck 2a to the hand 7, CH is the height of the claw 2f of the chuck 2a, and COH is the distance when the main arm 5 is held at the origin ZP and the main body 3 is moved in the direction A. When brought down (shown by imaginary lines in Figure 13a)
This is the distance from pallet 9a to hand 7.
Next, in step S3, the main arm 5 is moved in the direction C in FIG.
Movement in the D direction is referred to as "axis movement." ), hand 7
As shown in Fig. 13b, 1D=COH-l...(1) l: Position the workpiece at a position shifted in the direction C from the origin ZP by the total length input by the operator. Next, in step S4, the body is lowered in the A direction, and in step S5, the sub-arm 6 is rotated to load the loading hand (see "(L)" in the flowchart).
(displayed as "Hand") 7e toward the pallet 9a. In step S6, the teaching data memory 12 is searched, and if the operator specifies inner tightening grip in the teaching data TDT, the operation enters the inner tightening grip operation subroutine SUB1, and if the operator specifies outer tightening grip, the outer tightening grip is executed. Operation subroutine
Enter SUB2.

内締め把持動作サブルーチンSUB1は、第7
図に示すように、ステツプS7で、既にステツプ
S5で選択されているローデイングハンド7e側
の保持爪7a,7aを第2図I方向に移動させて
閉じ、ステツプS8でボデイダウン状態の場合
は、ステツプS9に入り、ハンド7を、第13図
cに示す、原点ZPから 2D=COH−g ……(2) g:オペレータが入力した加工前におけるワーク
把持位置。
The inner tightening gripping operation subroutine SUB1 is the seventh
As shown in the figure, in step S7, the holding claws 7a, 7a on the side of the loading hand 7e, which has already been selected in step S5, are moved in the direction I in FIG. , Step S9 is entered, and the hand 7 is moved from the origin ZP shown in FIG.

の位置まで軸移動させ、保持爪7a,7aをワー
ク26の内径部に挿入し、ステツプS10で保持
爪7a,7aを第2図H方向に開き、ワーク26
を内径側から把持する(第2図aに示す保持爪7
a,7aは、外形把持用であるが、保持爪7a,
7aは第2図bで示すような突起7g,7gの形
成された内径把持用の保持爪7a,7aと交換可
能であり、内径把持の際には予め保持爪7a,7
aを内径把持用に交換しておく。)。また、外締め
把持サブルーチンSUB2は、第8図に示すよう
に、ステツプS11で選択されているローデイン
グハンド7e側の保持爪7a,7aを第2図H方
向に開き、ステツプS12,S13を経由して位
置2Dにまで軸移動を行ない、ステツプS14で
保持爪7a,7aをI方向に移動させて、ワーク
26を外径側から把持する(第11図4参照)。
The shaft is moved to the position shown in FIG.
from the inner diameter side (holding claw 7 shown in Fig. 2a)
a, 7a are for gripping the external shape, holding claws 7a,
7a can be replaced with holding claws 7a, 7a for gripping the inner diameter formed with protrusions 7g, 7g as shown in FIG. 2b, and when gripping the inner diameter, the holding claws 7a, 7
Replace a with one for inner diameter gripping. ). Further, as shown in FIG. 8, the outer tightening gripping subroutine SUB2 opens the holding claws 7a, 7a on the loading hand 7e side selected in step S11 in the direction H in FIG. Then, in step S14, the holding claws 7a, 7a are moved in the I direction to grip the workpiece 26 from the outer diameter side (see FIG. 11, 4).

ワーク26を保持したところで、ダブルハンド
動作プログラムDHPに戻り、ステツプS15で
位置1Dへ軸移動し、ステツプS16で第1図B
方向にボデイアツプし(第11図5,6)、ステ
ツプS17で数値制御旋盤2のドア2bをL方向
に開け、ステツプS19で第13図dに示す位置
3D 3D=〔CHH−(CH+α+g)〕 ……(3) α:クリアランス量 へ軸移動させる。
After holding the workpiece 26, return to the double hand operation program DHP, move the axis to position 1D in step S15, and move to position 1D in step S16.
In step S17, the door 2b of the numerically controlled lathe 2 is opened in the L direction, and in step S19 it is moved to the position shown in FIG. 13d.
3D 3D=[CHH−(CH+α+g)] …(3) α: Move the axis to the clearance amount.

一方、ステツプS18でコンベアユニツト9を
駆動してパレツト9aを移動させ、新しいワーク
26をハンド7に供給し得る状態としておく。次
に、ステツプ20でメインアーム5をサブアーム
6と共に第1図E方向に回転させ、ハンド7を、
第11図7,8に示すように、チヤツク2aと対
向させ、ステツプS21でチヤツク2aの爪2f
を開き、更にステツプS22でハンド7を、第1
3図eに示す位置4D 4D=〔CHH−(g−β)〕 ……(4) β:押し付け量 へ軸移動させ、ワーク26を開放状態にあるチヤ
ツク2a中に挿入する。この際、ハンド7はワー
ク26がチヤツク2aと当接した後、更に押し付
け量βに相当する量だけJ方向に移動し、従つて
ローデイングハンド7eは、コイルばね7hの弾
性に抗して第2図K方向にβだけ移動し、その反
作用としてワーク26はJ方向、即ちチヤツク方
向に所定の圧力で押し付けられるので、ワーク2
6はチヤツク2aの所定位置に確実に挿入され
る。次に、ステツプ23でチヤツク2aをクラン
プし、ワーク26をチヤツク2aにより保持す
る。ステツプS24で内締めの場合はステツプS
25へ入つてハンド7の保持爪7aを閉じ(以
下、単に「ハンド7を閉じる」と表現する。)、外
締めの場合はステツプ26へ入つて保持爪7aを
開いて、ハンド7のワーク26に対する把持状態
を解除する。
On the other hand, in step S18, the conveyor unit 9 is driven to move the pallet 9a so that a new work 26 can be supplied to the hand 7. Next, in step 20, the main arm 5 and the sub arm 6 are rotated in the direction E in FIG.
As shown in FIGS. 7 and 8, the hook 2f of the chuck 2a is set opposite to the chuck 2a, and the claw 2f of the chuck 2a is opened in step S21.
is opened, and further, in step S22, hand 7 is moved to the first
Position 4D 4D=[CHH-(g-β)] as shown in Figure 3e (4) β: The axis is moved to the pressing amount and the workpiece 26 is inserted into the open chuck 2a. At this time, after the workpiece 26 comes into contact with the chuck 2a, the hand 7 further moves in the J direction by an amount corresponding to the pressing amount β, and therefore the loading hand 7e moves against the elasticity of the coil spring 7h. The workpiece 26 moves by β in the K direction in Fig. 2, and as a reaction, the workpiece 26 is pressed with a predetermined pressure in the J direction, that is, the chuck direction.
6 is securely inserted into a predetermined position of the chuck 2a. Next, in step 23, the chuck 2a is clamped, and the workpiece 26 is held by the chuck 2a. If internal tightening is performed at step S24, step S
25, close the holding claw 7a of the hand 7 (hereinafter simply referred to as "closing the hand 7"), and in the case of external tightening, proceed to step 26, open the holding claw 7a, and close the workpiece 26 of the hand 7. Release the grip state on.

次に、ステツプS90では、教示データメモリ
12を検索して、テイーチングに際してオペレー
タがリチヤツキングを指示したかどうかを判定
し、リチヤツキングが指示されていなかつた場合
には、直ちにステツプS27へ入つて、第13図
fに示す位置5D 5D=〔CHH−(l+α)〕 ……(5) へ軸移動を行なうが、リチヤツキング指示が出さ
れている場合には、リチヤツキング動作サブルー
チンSUB3に入る。リチヤツキング動作サブル
ーチンSUB3では、第9図に示すように、ステ
ツプS28で位置5Dへ軸移動を行なつた後、ス
テツプS5で選択状態にあるローデイングハンド
7eを閉じ、ステツプS29で、第13図fに示
す位置10D 10D=〔CHH−(l−β)〕 ……(6) へ軸移動を行なう。すると、ローデイングハンド
7eはチヤツク2aに保持されたワーク26と当
接し、更にβだけ第2図J方向に押し付けられ、
ワーク26はコイルばね7hによつて押し付け量
βに相当する力でJ方向に押し付けられる。この
状態で、ステツプS30,S31でチヤツク2a
を一度開閉させることにより、ワーク26はリチ
ヤツキングされ、より確実に保持される。
Next, in step S90, the teaching data memory 12 is searched to determine whether or not the operator has instructed re-charging at the time of teaching.If re-charging has not been instructed, the process immediately proceeds to step S27, and the 13th The axis is moved to the position 5D 5D=[CHH-(l+α)] (5) shown in FIG. f, but if a recharging instruction has been issued, the recharging operation subroutine SUB3 is entered. In the recharging operation subroutine SUB3, as shown in FIG. 9, the axis is moved to position 5D in step S28, the loading hand 7e in the selected state is closed in step S5, and the loading hand 7e in the selected state is closed in step S29. The axis is moved to the position 10D 10D=[CHH-(l-β)]...(6) shown in FIG. Then, the loading hand 7e comes into contact with the workpiece 26 held by the chuck 2a, and is further pushed in the direction J in FIG. 2 by β.
The workpiece 26 is pressed in the J direction by the coil spring 7h with a force corresponding to the pressing amount β. In this state, check 2a is selected in steps S30 and S31.
By opening and closing the workpiece 26 once, the workpiece 26 is recharged and held more securely.

リチヤツキングの後、ステツプS27で位置
5Dへ軸移動した後、ステツプS32でサブアー
ム6を第1図F方向に上昇させ、ステツプS33
でドア2bを閉じて数値制御旋盤2による加工を
開始する。次にステツプS34では未加工のワー
ク26がコンベアユニツト9のパレツト9a上に
有るか否かを、教示データTDTのワークの数か
ら判定し、ワーク26が有る場合には、ステツプ
S35,S36により位置1Dへ軸移動し、A方
向に本体3をボデイダウンさせる。以下、第11
図12乃至14に示すように、ステツプS37か
らS38でパレツト9a上の新しい未加工ワーク
26をローデイングハンド7eに把持させ、ステ
ツプS39でアンローデイングハンド(フローチ
ヤート中「(U)ハンド」と表示。)7cにワーク2
6が有る場合には、ステツプS54へジヤンプす
るが、最初はアンローデイングハンド7cにはワ
ーク26が把持されていないので、ステツプS4
1で本体3をB方向にボデイアツプし、ステツプ
S42でコンベアユニツト9のパレツト9aを移
動させ次に加工すべきワーク26をハンド7へ供
給し得る状態とする。更に、ステツプS43でサ
ブアーム6をG方向に回転させてアンローデイン
グハンド7cを選択し(第11図16)、加工が
終了し、ドア2bが開放されたところで、ステツ
プS44,S45で軸移動の後、サブアーム6を
E方向に下降させ、ステツプS45以下で、チヤ
ツク2aの加工済みワーク26をアンローデイン
グハンド7cを用いて、第11図17乃至19に
示すように、把持する。この際、各把持動作サブ
ルーチンSUB1,SUB2では、本体3がボデイ
ダウン状態ではないので、ステツプS47,S4
9を実行し、アンローデイングハンド7cはチヤ
ツク2a中のワーク26を把持し得る位置6D 6D〔CHH−g′〕 ……(7) g′:オペレータが入力した加工後におけるワーク
把持位置。
After recharging, position in step S27.
After the axis moves to 5D, the sub-arm 6 is raised in the direction F in Fig. 1 in step S32, and then in step S33.
The door 2b is closed and machining by the numerically controlled lathe 2 is started. Next, in step S34, it is determined whether there is an unprocessed work 26 on the pallet 9a of the conveyor unit 9 based on the number of works in the teaching data TDT, and if there is a work 26, the position is determined in steps S35 and S36. Move the axis to 1D and lower the body 3 in the A direction. Below, the 11th
As shown in FIGS. 12 to 14, in steps S37 to S38, the new unprocessed workpiece 26 on the pallet 9a is gripped by the loading hand 7e, and in step S39, the unloading hand (indicated as "(U) hand" in the flowchart) .) Work 2 on 7c
6, the process jumps to step S54, but since the workpiece 26 is not gripped by the unloading hand 7c at first, the process jumps to step S54.
At step S1, the main body 3 is lifted up in the direction B, and at step S42, the pallet 9a of the conveyor unit 9 is moved so that the workpiece 26 to be processed next can be supplied to the hand 7. Furthermore, in step S43, the sub-arm 6 is rotated in the G direction to select the unloading hand 7c (Fig. 11, 16), and when the machining is completed and the door 2b is opened, the unloading hand 7c is rotated in the G direction in steps S44 and S45. , the sub-arm 6 is lowered in the E direction, and from step S45 onwards, the processed workpiece 26 of the chuck 2a is gripped using the unloading hand 7c as shown in FIGS. 17 to 19. At this time, in each of the gripping operation subroutines SUB1 and SUB2, the main body 3 is not in the body-down state, so steps S47 and S4 are performed.
9 is executed, and the unloading hand 7c is at a position 6D 6D [CHH-g'] where the unloading hand 7c can grip the workpiece 26 in the chuck 2a. (7) g': Workpiece gripping position after machining input by the operator.

まで軸移動させられ、ステツプS10,S14で
加工済みのワーク26を把持する。ワーク26を
把持したところで、ステツプS47,S48でチ
ヤツク2aが開き、軸移動を位置7D 7D=〔CHH−(CH+γ+※)〕 ……(8) γ:クリアランス量 ※:g、g′のうち大きい方の量 まで行なう。そこで、ステツプS49でローデイ
ングハンド7eにワーク26が有るか否かを判定
し(所定の数のワーク26の加工が完了する時以
外は、ローデイングハンド7eにワーク26は存
在する。)、存在する場合には、ステツプS50
で、テイーチングに際してオペレータが機械外、
即ち、数値制御旋盤2外での反転を指示したかど
うかを教示データTDTから判定し、指示してい
ない場合には、ステツプS51で直ちにサブアー
ム6を回転させて、未加工のワーク26を把持し
たローデイングハンド7eを機械内でチヤツク2
a側に向ける(第11図20)。一方、機械外で
の反転を指示している場合には、機械外反転動作
サブルーチンSUB4に入り、ステツプS52以
下で、サブアーム6を一度F方向に上昇させ、ハ
ンド7をワーク26と共に機械外に出してハンド
7を反転させた後、再度サブアーム6をE方向に
下降させ、機械内へワーク26を入れる。こうし
て、反転動作が終ると、ステツプS52で再度位
置4Dへ軸移動を行ない、未加工のワーク26を
チヤツク2aへ装着し、ステツプS53からS2
4へジヤンプし、以後、フローチヤートに従つて
ステツプS34を通つてS39まで同述と同様の
動作を行ない、一方のワークの加工中に新たなワ
ーク26をローデイングハンド7eに把持させる
(第10図21乃至26)。
The processed workpiece 26 is gripped in steps S10 and S14. When the workpiece 26 is gripped, the chuck 2a is opened in steps S47 and S48, and the axis is moved to the position 7D 7D=[CHH-(CH+γ+*)]...(8) γ: Clearance amount *: Larger of g and g' Do as much as you like. Therefore, in step S49, it is determined whether or not there is a workpiece 26 in the loading hand 7e (the workpiece 26 is present in the loading hand 7e except when machining of a predetermined number of workpieces 26 is completed). If so, step S50
When teaching, the operator is outside the machine.
That is, it is determined from the teaching data TDT whether or not reversal outside the numerically controlled lathe 2 has been instructed, and if not, the sub-arm 6 is immediately rotated in step S51 to grip the unprocessed workpiece 26. Check loading hand 7e in machine 2
Turn it toward the a side (Fig. 11, 20). On the other hand, if a reversal outside the machine is instructed, the reversal operation outside the machine subroutine SUB4 is entered, and in steps S52 and below, the sub arm 6 is once raised in the direction F, and the hand 7 is taken out of the machine together with the workpiece 26. After the hand 7 is reversed, the sub-arm 6 is lowered again in the E direction, and the workpiece 26 is put into the machine. When the reversing operation is completed in this way, the axis is moved again to position 4D in step S52, the unprocessed workpiece 26 is mounted on the chuck 2a, and steps S53 to S2
4, and thereafter performs the same operations as described above through step S34 and up to step S39 according to the flowchart, and causes the loading hand 7e to grip a new workpiece 26 while the other workpiece is being processed (the 10th Figures 21 to 26).

アンローデイングハンド7cには、この場合、
加工済みワーク26が把持されているので、ステ
ツプS39からS54へジヤンプし、一度、原点
ZPへメインアーム5を軸移動させた後、ステツ
プS55でアンローデイングハンド7cを選択し
(第12図27)、ステツプS56でコンベアユニ
ツト9を駆動してハンド7cに把持されている加
工済みワーク26が置かれていたパレツト9aを
所定位置に位置決めし、ステツプS40で位置
2Dへ軸移動の後、ステツプS57,S58でパ
レツト9a上に加工済みワーク26を置く(第1
0図28)。
In this case, the unloading hand 7c includes:
Since the machined workpiece 26 is being gripped, the process jumps from step S39 to S54 and returns to the origin once.
After the main arm 5 is axially moved to ZP, the unloading hand 7c is selected in step S55 (FIG. 12, 27), and the conveyor unit 9 is driven in step S56 to remove the processed workpiece 2 held by the hand 7c. The pallet 9a on which the
After the axis movement to 2D, the processed workpiece 26 is placed on the pallet 9a in steps S57 and S58 (first
0 Figure 28).

その後、ステツプS59,S60で軸移動及び
B方向へのボデイアツプを行なうと、第10図2
9及び第14図に示すような状態となる。即ち、
パレツト9aは2個が空となり、それ等パレツト
9a上に搭載されていた2個のワーク26のう
ち、1個はチヤツク2aによつて保持され加工中
であり、他の1個はローデイングハンド7eに把
持されている。
After that, when the axis is moved and the body is raised in the direction B in steps S59 and S60, as shown in FIG.
The state will be as shown in FIGS. 9 and 14. That is,
Two of the pallets 9a are now empty, and of the two workpieces 26 that were loaded on the pallet 9a, one is being held by the chuck 2a and is being processed, and the other is being held by the loading hand. 7e.

次に、ステツプS61では、現在数値制御旋盤
2がワーク26を加工中であるか否かを判定し、
加工中の場合には、加工終了まで待つてステツプ
S62から前述と同様の動作を繰り返す。
Next, in step S61, it is determined whether the numerically controlled lathe 2 is currently machining the workpiece 26,
If machining is in progress, wait until machining is completed and repeat the same operations as described above from step S62.

こうして、加工が進行する内に、パレツト9a
上に未加工のワーク26がなくなり、加工作業の
終了が近づくと、ステツプS34からS54へジ
ヤンプし、それまで行なつていた新たな未加工の
ワーク26のパレツト9a上から把持動作を止
め、加工済みのワーク26のみをパレツト9aに
戻し、更にステツプS61からS62へジヤンプ
し、現在加工中の最後のワーク26を加工終了と
共にチヤツク2aから取り出す。しかし、最早、
ローデイングハンド7eには未加工ワーク26が
把持されていないので、ステツプS49からS6
3へ入り、ハンド7は反転動作を行なうことなく
サブアーム6がF方向に上昇し、ボデイダウンの
後、ステツプS40へジヤンプし、最後の加工済
みワーク26をパレツト9a上に戻し、ステツプ
S61を経由して全ての作業を終了する。
In this way, while the processing progresses, the pallet 9a
When there is no more unprocessed work 26 on top and the end of the machining operation approaches, the process jumps from step S34 to S54, stops the gripping operation of the new unprocessed work 26 from above the pallet 9a, and starts machining. Only the completed workpiece 26 is returned to the pallet 9a, and the process further jumps from step S61 to S62, and the last workpiece 26 currently being processed is taken out from the chuck 2a upon completion of processing. However, no longer
Since the unprocessed workpiece 26 is not held by the loading hand 7e, steps S49 to S6 are performed.
3, the hand 7 moves the sub-arm 6 up in the F direction without performing a reversal operation, and after lowering the body, jumps to step S40, returns the last machined workpiece 26 onto the pallet 9a, and goes through step S61. to finish all work.

以上で、ダブルハンド動作プログラムDHPの
説明が終了したので、以下、シングルハンド動作
プログラムSHPについて、第6図及び第12図
に基いて説明する。なお、各ステツプにおける、
ダブルハンドと共通の動作はその説明を省略す
る。まず、ステツプS70,S71でボデイアツ
プと原点への軸移動を行ない、ステツプS72
で、第13図bに示す位置1S 1S=〔COH−l〕 ……(9) へ軸移動を行なう。次にボデイダウンの後、内締
め把持動作サブルーチンSUB1又は外締め把持
動作サブルーチンSUB2へ入る(当然、シング
ルハンドのハンド7も、保持爪7aを交換するこ
とにより、内締め及び外締めの両方が可能であ
る。)。サブルーチンSUB1,SUB2におけるス
テツプS9,S13の軸移動位置2Sは、第13
図cに示すよう 2S=〔COH−g〕 ……(10) である。こうして第12図1乃至5に示すよう
に、コンベアユニツト9のパレツト9a上のワー
ク26を把持した後、ステツプS73でボデイア
ツプし、ステツプS74までの間で、ワーク26
をチヤツク2aに挿入保持させ(第12図6乃至
9)、ステツプS75でリチヤツキングが指示さ
れていれば、第9図に示すリチヤツキング動作サ
ブルーチンSUB3へ入る。なお、ステツプS7
7,S79及びサブルーチンSUB3中の位置3S、
4S、5S、10Sは、第13図d,e,fに示すよう
に、 3S=〔CHH−(CH+α+g)〕 ……(11) 4S=〔CHH−(g−β)〕 ……(12) 5S=〔CHH−(l+α)〕 ……(13) 10S=〔CHH−(l−β)〕 ……(14) である。
Now that the explanation of the double hand operation program DHP has been completed, the single hand operation program SHP will be explained below with reference to FIGS. 6 and 12. In addition, in each step,
Descriptions of actions common to double hand will be omitted. First, in steps S70 and S71, the body is raised and the axis is moved to the origin, and then in step S72
Then, the axis is moved to the position 1S 1S=[COH-l] . . . (9) shown in FIG. 13b. Next, after lowering the body, the process enters the inner tightening gripping operation subroutine SUB1 or the outer tightening gripping operation subroutine SUB2 (of course, the single-handed hand 7 can also perform both inner tightening and outer tightening by replacing the holding claw 7a. ). The axis movement position 2S in steps S9 and S13 in subroutines SUB1 and SUB2 is the 13th
As shown in Figure c, 2S=[COH-g]...(10). In this way, as shown in FIGS. 1 to 5, after gripping the workpiece 26 on the pallet 9a of the conveyor unit 9, the body is lifted up in step S73, and up to step S74, the workpiece 26 is
is inserted and held in the chuck 2a (FIG. 12, 6 to 9), and if recharging is instructed in step S75, the recharging operation subroutine SUB3 shown in FIG. 9 is entered. Note that step S7
7, S79 and position 3S in subroutine SUB3,
4S, 5S, and 10S are as shown in Figure 13 d, e, and f, 3S = [CHH-(CH+α+g)]...(11) 4S=[CHH-(g-β)]...(12) 5S=[CHH-(l+α)]...(13) 10S=[CHH-(l-β)]...(14).

次に、サブアーム6がハンド7と共にF方向に
上昇し(第12図10,11)、ドア2bが閉じ
てワーク26に対する加工が開始される。シング
ルハンドはステツプS76で加工が開始された後
は、加工終了まで待機する。従つて、コンベアユ
ニツト9のパレツト9aは、第15図に示すよう
に、現在加工中のワーク26に対応したものだけ
が空であり、ハンド7もワーク26を把持しない
状態で待機する。ステツプS77で加工が終了す
ると、サブアーム6が機械内へ入り、第12図1
2乃至15に示すように、加工済みのワーク26
をチヤツク2aから取り外す。把持動作サブルー
チンSUB1,SUB2及びステツプS80におけ
る軸移動の位置6S、7Sは、第13図g,iに示
すように、 6S=〔CHH−g′〕 ……(15) 7S=〔CHH−(CH+α+g′)〕 ……(16) である。次に、ステツプS81で位置8S、 8S=〔COH−(g′+α)〕 ……(17) へ軸移動した後、ボデイダウンし、パレツト9a
上に加工済みのワーク26を戻して(第12図1
6乃至18)、第13図kに示す位置9S 9S=〔COH−(α+l)〕 ……(18) へ軸移動し、ステツプS82で未加工ワーク26
がコンベアユニツト9のパレツト9a上にあるか
否かを判定し、有る場合には、ステツプS83で
コンベアユニツト9を移動させて、新しいワーク
26を、ハンド7が把持し得る位置へ供給位置決
めし、ステツプS84へジヤンプし、新しいワー
ク26の把持動作に入る。こうして、パレツト9
a上の未加工ワーク26が無くなるまで同様の動
作を繰り返し、ステツプS82でワーク26が無
くなつたところで加工作業は終了する。
Next, the sub-arm 6 moves up in the F direction together with the hand 7 (FIGS. 12, 10 and 11), the door 2b closes, and machining of the workpiece 26 is started. After machining is started in step S76, the single hand waits until the machining is completed. Therefore, as shown in FIG. 15, the pallet 9a of the conveyor unit 9 is empty only for the one corresponding to the workpiece 26 currently being processed, and the hand 7 also waits without gripping the workpiece 26. When the machining is completed in step S77, the sub-arm 6 enters the machine, and as shown in FIG.
As shown in 2 to 15, the processed workpiece 26
Remove from chuck 2a. The axial movement positions 6S and 7S in the grasping operation subroutines SUB1 and SUB2 and step S80 are as shown in FIG. ′)] ...(16). Next, in step S81, after moving the axis to position 8S, 8S=[COH-(g'+α)]...(17), the body is lowered and pallet 9a is moved.
Return the processed workpiece 26 on top (Fig. 12 1)
6 to 18), the axis moves to the position 9S=[COH-(α+l)]...(18) shown in FIG. 13k, and in step S82, the unprocessed workpiece 26
is on the pallet 9a of the conveyor unit 9, and if so, in step S83 the conveyor unit 9 is moved to supply and position a new work 26 to a position where the hand 7 can grip it, The process jumps to step S84, and a new workpiece 26 is gripped. In this way, palette 9
The same operation is repeated until there are no more unprocessed workpieces 26 on a, and the machining operation ends when there are no more workpieces 26 at step S82.

こうして、主制御部10は、動作プログラムメ
モリ16中の動作プログラムAPROに基いて、
ワーク26を数値制御旋盤2に対して搬入・搬出
してゆくが、各動作プログラムAPRO中のサブ
ルーチンSUB1〜SUB4は、固有動作メモリ1
7中に格納され、動作プログラムAPRO中でサ
ブルーチンSUB1〜SUB4の実行が指示される
と、当該サブルーチンSUB1〜SUB4を固有動
作メモリ17から読み出し、実行する。また、前
述の各種寸法及び距離、即ち第13図におけるチ
ヤツク2aからハンド7までの距離CHH、パレ
ツト9aからハンド7までの距離COH、チヤツ
ク2aの爪2fの高さCH、クリアランス量α、
押し付け量β、クリアランス量γ等の値は、固定
値として軸移動量メモリ20中にセツトされてい
るので、教示データTDTとして、ワーク全長l、
加工前後におけるワーク26の把持位置g、g′が
入力されると、直ちに位置1D、2D、…7D、9D、
10D、1S、2S、…10S主制御部10によつて演算
決定され、メモリ20中に格納される。従つて、
動作プログラムAPROの実行時には、メモリ2
0を検索することにより直ちに所定の軸移動位置
が判明し、ハンドリングロボツト1の動作は円滑
かつ迅速に行なわれる。
In this way, the main control unit 10, based on the operation program APRO in the operation program memory 16,
The workpiece 26 is carried in and out of the numerically controlled lathe 2, and subroutines SUB1 to SUB4 in each operation program APRO are stored in the specific operation memory 1.
When execution of subroutines SUB1 to SUB4 is instructed in the operation program APRO, the subroutines SUB1 to SUB4 are read from the specific operation memory 17 and executed. In addition, the various dimensions and distances mentioned above, namely the distance CHH from the chuck 2a to the hand 7 in FIG. 13, the distance COH from the pallet 9a to the hand 7, the height CH of the claw 2f of the chuck 2a, the clearance amount α,
Since the values of the pushing amount β, the clearance amount γ, etc. are set as fixed values in the axis movement amount memory 20, the workpiece total length l,
When the gripping positions g and g' of the workpiece 26 before and after machining are input, the positions 1D, 2D, ...7D, 9D,
10D, 1S, 2S, . . . 10S are calculated and determined by the main control unit 10 and stored in the memory 20. Therefore,
When executing the operation program APRO, memory 2
By searching for 0, the predetermined axis movement position can be immediately determined, and the handling robot 1 can operate smoothly and quickly.

ところで、主制御部10は動作プログラムメモ
リ16中の動作プログラムAPROに従つて駆動
制御部11を介してアクチエータ21を駆動制御
し、ハンドリングロボツト1に所定の動作を行な
わせてゆくが、動作プログラムAPROの各動作
ステツプS1,S2,S3…は、その実行を主制
御部10が駆動制御部11に指令する度に、表示
制御部15が出力される。表示制御部15はそれ
を受けて、動作名称メモリ23を検索し、各動作
ステツプS1,S2,…に対応した表示パターン
PATを読み出し、デイスプレイ25上に表示す
る。例えばダブルハンド動作プログラムDHPの
実行に際して、主制御部10がプログラムDHP
に基いてステツプS16のボデイアツプを駆動制
御部11に指令すると、制御部11は直ちに対応
するアクチエータ21を駆動して本体3を第1図
B方向に回動させるが、その際、デイスプレイ2
5上には、ステツプS16のボデイアツプに対応
する表示パターンPATが、例えば、第16図a
に示すように、表示される。本体3のボデイアツ
プが完了すると、デイスプレイ25上の
「BODY−UP」の表示は消える。主制御部10
は次にステツプS17の実行を駆動制御部11に
指令する。すると、直ちにステツプS17のドア
開に対応する表示パターンPATが動作名称メモ
リ23から読み出され、デイスプレイ25上に、
第16図bに示すように、表示される。また、ス
テツプS19等の軸移動の表示に際しては、軸移
動に対応する表示パターンPAT、例えば「Z−
DRIVE」の他に、移動すべき位置1D、2D…1S、
2S…等も共に、デイスプレイ25上に、第16
図cに示すように、表示される(第16図cで
は、位置3Dへの軸移動を表示。)。動作名称メモ
リ23には、ハンドリングロボツト1が実行する
各動作ステツプS1,S2,…に対応した表示パ
ターンPTAが格納されているので、現在ロボツ
ト1が実行しているステツプS1,S2,…は、
デイスプレイ25上に常に表示され、オペレータ
はデイスプレイ25を見るだけで、現在ロボツト
1が実行中のステツプS1,S2,…を直ちに知
ることができる。デイスプレイ25上の表示は、
表示されているパターンPATに対応するステツ
プの動作が完了し、次のステツプの指令が主制御
部10より出されない限り、同一の表示パターン
PATを表示し続けるので、万一、無人作業時に、
ロボツト1の動作に障害が生じ、安全上自動的に
非常停止状態となつたとしても、オペレータはデ
イスプレイ25上の表示を見るだけで、ロボツト
1が現在どのような状態で停止しているかを直ち
に認識することができる。
By the way, the main control unit 10 drives and controls the actuator 21 via the drive control unit 11 according to the operation program APRO in the operation program memory 16, and causes the handling robot 1 to perform a predetermined operation. Each operation step S1, S2, S3 . In response to this, the display control unit 15 searches the operation name memory 23 and creates a display pattern corresponding to each operation step S1, S2,...
The PAT is read out and displayed on the display 25. For example, when executing the double hand operation program DHP, the main control unit 10 executes the program DHP.
When the drive control unit 11 is instructed to raise the body in step S16 based on
5, the display pattern PAT corresponding to the body up in step S16 is shown, for example, in FIG. 16a.
will be displayed as shown. When the body raising of the main body 3 is completed, the "BODY-UP" indication on the display 25 disappears. Main control unit 10
Next, the controller 11 instructs the drive control section 11 to execute step S17. Immediately, the display pattern PAT corresponding to the door opening in step S17 is read out from the operation name memory 23, and the following is displayed on the display 25.
It is displayed as shown in FIG. 16b. In addition, when displaying the axis movement in step S19, etc., the display pattern PAT corresponding to the axis movement, for example, "Z-
In addition to “DRIVE”, the position to move to is 1D, 2D…1S,
2S... etc. are also displayed on the display 25.
It is displayed as shown in Figure c (Figure 16c shows the axis movement to position 3D). Since the operation name memory 23 stores display patterns PTA corresponding to each operation step S1, S2, ... executed by the handling robot 1, the steps S1, S2, ... currently executed by the robot 1 are
It is always displayed on the display 25, and the operator can immediately know which steps S1, S2, etc. are currently being executed by the robot 1 just by looking at the display 25. The display on the display 25 is
The same display pattern will continue until the operation of the step corresponding to the displayed pattern PAT is completed and a command for the next step is not issued from the main control unit 10.
PAT will continue to be displayed, so in the event of unattended operation,
Even if a failure occurs in the operation of the robot 1 and the robot automatically enters an emergency stop state for safety reasons, the operator can immediately tell in what state the robot 1 is currently stopped by simply looking at the display on the display 25. can be recognized.

なお、動作プログラムAPRO及び、動作プロ
グラムAPRO中の各サブルーチンSUB1,SUB
2…を構成する動作ステツプS1,S2,…は必
要に応じて入替え、変更が可能であり、また機能
を多様化、又は単純化するために、動作ステツプ
の増加(新規な動作を行なう、本実施例では示さ
れていない動作ステツプも含む)、減少等も自由
に行なえることは勿論である。
In addition, the operation program APRO and each subroutine SUB1, SUB in the operation program APRO
The operation steps S1, S2, etc. that make up 2. (including operation steps not shown in the embodiment), reduction, etc. can be freely performed.

以上説明したように、本発明によれば、2個以
上の動作ステツプS1,S2…から構成される、
リチヤツキング動作サブルーチンをSUB3等の
リチヤツキング動作ルーチンを、選択的に実行可
能なるように設けた動作プログラムAPROを格
納した、動作プログラムメモリ16、固有動作メ
モリ17等のメモリ、及び前記ルーチンの選択を
指示するリチヤツキング指令キー13c等のルー
チン指示手段を設けたので、テイーチングに際し
て、リチヤツキング動作を行なうか否かを前記指
示手段を操作するだけで指示することができ、従
来のように、各動作ステツプをキーボードからい
ちいち指令する必要がなく、テイーチング時間の
短縮化に寄与し得る。また、オペレータは、リチ
ヤツキング動作に関して、ハンドリングロボツト
1がどのような動作ステツプを経て動作するのか
を知る必要がなく、単にルーチン指示手段を操作
すれば足りるので、初心者でも容易に指示が可能
である。
As explained above, according to the present invention, the operation step is composed of two or more operation steps S1, S2...
Memories such as the operation program memory 16 and the specific operation memory 17, which store an operation program APRO that is provided so as to be able to selectively execute a recharging operation routine such as a recharging operation subroutine SUB3, and instruct the selection of the routine. Since a routine instruction means such as a recharging command key 13c is provided, during teaching, it is possible to instruct whether or not to perform a recharging operation simply by operating the instruction means. There is no need to give instructions one by one, which can contribute to shortening teaching time. In addition, the operator does not need to know what kind of operation steps the handling robot 1 goes through regarding the recharging operation, and only needs to operate the routine instruction means, so that even a beginner can easily instruct the recharging operation.

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

第1図は本発明の一実施例であるハンドリング
ロボツトを数値制御旋盤に装着した際の一例を示
す斜視図、第2図はダブルハンドを示す図で、a
は外締め用、bは内締め用、第3図はシングルハ
ンドを示す斜視図、第4図は第1図のハンドリン
グロボツトの制御ブロツク図、第5図はダブルハ
ンド動作プログラムの一例を示すフローチヤー
ト、第6図はシングルハンド動作プログラムの一
例を示すフローチヤート、第7図は内締め把持動
作サブルーチンの一例を示すフローチヤート、第
8図は外締め把持動作サブルーチンの一例を示す
フローチヤート、第9図はリチヤツキング動作サ
ブルーチンの一例を示すフローチヤート、第10
図は機械外反転動作サブルーチンの一例を示すフ
ローチヤート、第11図はダルブハンドの第5図
に示す動作プログラムに基く動作態様を示す図、
第12図はシングルハンドの第6図に示す動作プ
ログラムに基く動作態様を示す図、第13図はハ
ンド、ワーク、コンベアユニツトのパレツト及び
数値制御旋盤のチヤツク間の寸法関係を示す図、
第14図はダブルハンドを用いた際の、加工中に
おける各部の状態を示す図、第15図はシングル
ハンドを用いた際の、加工中における各部の状態
を示す図、第16図は各動作ステツプに対応する
表示パターンの、デイスプレイ上での表示の一例
を示す図である。 1……ハンドリングロボツト、2……工作機械
(数値制御旋盤)、13c……ルーチン指示手段
(リチヤツキング指令キー)、16……メモリ(動
作プログラムメモリ)、17……メモリ(固有動
作メモリ)、26……ワーク、SUB3……リチヤ
ツキング動作ルーチン(リチヤツキング動作サブ
ルーチン)、APRO……動作プログラム、S1,
S2,S3……動作ステツプ。
Fig. 1 is a perspective view showing an example of a handling robot according to an embodiment of the present invention mounted on a numerically controlled lathe, and Fig. 2 is a diagram showing a double hand.
3 is a perspective view showing a single hand, FIG. 4 is a control block diagram of the handling robot shown in FIG. 1, and FIG. 5 is a flowchart showing an example of a double hand operation program. 6 is a flowchart showing an example of a single hand operation program, FIG. 7 is a flowchart showing an example of an inner tightening gripping operation subroutine, and FIG. 8 is a flowchart showing an example of an outer tightening gripping operation subroutine. FIG. 9 is a flowchart showing an example of the recharging operation subroutine, No. 10.
FIG. 11 is a flowchart showing an example of a subroutine for reversing the outside of the machine, FIG. 11 is a diagram showing an operation mode based on the operation program shown in FIG.
FIG. 12 is a diagram showing the operation mode based on the operation program shown in FIG. 6 for a single hand, and FIG. 13 is a diagram showing the dimensional relationship between the hand, workpiece, pallet of the conveyor unit, and chuck of the numerically controlled lathe.
Figure 14 is a diagram showing the state of each part during machining when using a double hand, Figure 15 is a diagram showing the state of each part during machining when using a single hand, and Figure 16 is a diagram showing each operation. FIG. 6 is a diagram showing an example of a display pattern corresponding to a step on a display. 1... Handling robot, 2... Machine tool (numerically controlled lathe), 13c... Routine instruction means (recharging command key), 16... Memory (operation program memory), 17... Memory (specific operation memory), 26 ...Work, SUB3... Recharging operation routine (recharging operation subroutine), APRO... Operation program, S1,
S2, S3...operation steps.

Claims (1)

【特許請求の範囲】[Claims] 1 ワークを把持し、工作機械に対して前記ワー
クを搬入・搬出するハンドリングロボツトにおい
て、2個以上の動作ステツプから構成される、リ
チヤツキング動作ルーチンを選択的に実行可能な
るように構成した動作プログラムを格納したメモ
リ、及び前記リチヤツキング動作ルーチンの選択
を指示するルーチン指示手段を設け、前記指示手
段を操作することにより、リチヤツキング動作の
実行を指示し得るようにして構成したハンドリン
グロボツト。
1 In a handling robot that grips a workpiece and carries the workpiece into and out of a machine tool, an operation program configured to selectively execute a recharging operation routine consisting of two or more operation steps is provided. The handling robot is provided with a stored memory and a routine instruction means for instructing selection of the recharging operation routine, and is configured to be able to instruct execution of the recharging operation by operating the instruction means.
JP57215131A 1982-12-08 1982-12-08 Handling robot Granted JPS59107838A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP57215131A JPS59107838A (en) 1982-12-08 1982-12-08 Handling robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP57215131A JPS59107838A (en) 1982-12-08 1982-12-08 Handling robot

Publications (2)

Publication Number Publication Date
JPS59107838A JPS59107838A (en) 1984-06-22
JPH0455817B2 true JPH0455817B2 (en) 1992-09-04

Family

ID=16667223

Family Applications (1)

Application Number Title Priority Date Filing Date
JP57215131A Granted JPS59107838A (en) 1982-12-08 1982-12-08 Handling robot

Country Status (1)

Country Link
JP (1) JPS59107838A (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2503085B2 (en) * 1989-12-15 1996-06-05 富士機械製造 株式会社 Industrial robot
JPH0722905B2 (en) * 1993-07-19 1995-03-15 富士機械製造株式会社 Automatic processing line

Also Published As

Publication number Publication date
JPS59107838A (en) 1984-06-22

Similar Documents

Publication Publication Date Title
US5570992A (en) Free-traveling manipulator with optical feedback control and methods
JPS6128461B2 (en)
US4553077A (en) Industrial robot
JP2019025562A (en) Robot control device and production system
JPH0440506A (en) Teaching device for robot
EP0086848A1 (en) Robot operation teaching method
JPH0455817B2 (en)
JPH0549426B2 (en)
JPS59107841A (en) Indication of motion step in handling robot
JPS58105303A (en) Teaching system
JPH11114757A (en) Method for controlling tool change
JPS59107839A (en) Handling robot
JPS59107837A (en) Handling robot
JP3057123B2 (en) Portable industrial robot
JPS59115182A (en) Handling robot
JPS61131001A (en) Controller for robot
JP7447411B2 (en) Control equipment, machine equipment, control methods, transfer control programs
JPH0421201B2 (en)
JPH04159055A (en) Work conveying device on machine tool
JP2624134B2 (en) Loader teaching method and teaching operation box
JPS61197144A (en) Method to use flexible loading device for machine tool
JP2000176868A (en) Robot control device
CN210589322U (en) Workpiece grabbing control system of manipulator
KR830002787B1 (en) Industrial Robot System
KR0157866B1 (en) Method and device of robot control