JPS5858682B2 - 産業用ロボツトの制御方式 - Google Patents
産業用ロボツトの制御方式Info
- Publication number
- JPS5858682B2 JPS5858682B2 JP53049413A JP4941378A JPS5858682B2 JP S5858682 B2 JPS5858682 B2 JP S5858682B2 JP 53049413 A JP53049413 A JP 53049413A JP 4941378 A JP4941378 A JP 4941378A JP S5858682 B2 JPS5858682 B2 JP S5858682B2
- Authority
- JP
- Japan
- Prior art keywords
- workpiece
- teaching
- address
- data
- 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
Links
- 238000000034 method Methods 0.000 title claims description 8
- 230000007547 defect Effects 0.000 claims description 5
- 230000002950 deficient Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 238000003754 machining Methods 0.000 description 5
- 230000002159 abnormal effect Effects 0.000 description 3
- 230000005856 abnormality Effects 0.000 description 3
- 238000003825 pressing Methods 0.000 description 3
- 230000004044 response Effects 0.000 description 2
- SYUHGPGVQRZVTB-UHFFFAOYSA-N radon atom Chemical compound [Rn] SYUHGPGVQRZVTB-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/04—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
- B25J9/041—Cylindrical coordinate type
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/409—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by using manual data input [MDI] or by using control panel, e.g. controlling functions with the panel; characterised by control panel details or by setting parameters
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/418—Total 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] or computer integrated manufacturing [CIM]
- G05B19/41815—Total 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] or computer integrated manufacturing [CIM] characterised by the cooperation between machine tools, manipulators and conveyor or other workpiece supply system, workcell
- G05B19/41825—Total 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] or 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/42—Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
- G05B19/425—Teaching successive positions by numerical control, i.e. commands being entered to control the positioning servo of the tool head or end effector
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/36—Nc in input of data, input key till input tape
- G05B2219/36296—Order, select, determine, change machining sequence, order
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/36—Nc in input of data, input key till input tape
- G05B2219/36499—Part program, workpiece, geometry and environment, machining dependant, combine
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/36—Nc in input of data, input key till input tape
- G05B2219/36511—Select by a detector
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/36—Nc in input of data, input key till input tape
- G05B2219/36513—Select out of a plurality of programs, patterns
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/36—Nc in input of data, input key till input tape
- G05B2219/36523—Select with code on workpiece, fixture, clamp, object
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45213—Integrated manufacturing system ims, transfer line, machining center
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Robotics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Mechanical Engineering (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Artificial Intelligence (AREA)
- Quality & Reliability (AREA)
- Human Computer Interaction (AREA)
- Numerical Control (AREA)
Description
【発明の詳細な説明】
本発明は、外部からの情報に対応した動作を行なわせる
ことができる産業用ロボットの制御方式%式% 工作機械の工具交換やワーク交換等を産業用ロボットで
行なわせることが実用化されている。
ことができる産業用ロボットの制御方式%式% 工作機械の工具交換やワーク交換等を産業用ロボットで
行なわせることが実用化されている。
このような産業用ロボットは、予め定められたプログラ
ムに従った一定の順序の動作を行なうのが一般的である
。
ムに従った一定の順序の動作を行なうのが一般的である
。
しかし、ワークの種類に対応した加工を行なわせる場合
、常に一定の順序で産業用ロボットが動作していては待
ち時間が長くなる可能性が多く、このような待ち時間を
少なくする為にはプログラムが複雑となる。
、常に一定の順序で産業用ロボットが動作していては待
ち時間が長くなる可能性が多く、このような待ち時間を
少なくする為にはプログラムが複雑となる。
従って従来の産業用ロボットは同一順序動作を繰返すよ
うな、専用的用途として利用されているものであった。
うな、専用的用途として利用されているものであった。
本発明は、教示データに従って動作を制御させると共に
、ワークの種類情報やワーク不良信号の外部情報に対応
して教示データによるシーケンスの変更を行なわせ、産
業用ロボットを有効に動作させることを目的とするもの
である。
、ワークの種類情報やワーク不良信号の外部情報に対応
して教示データによるシーケンスの変更を行なわせ、産
業用ロボットを有効に動作させることを目的とするもの
である。
以下実施例について詳細に説明する。
第1図は産業用ロボット及び工作機械の説明図であり、
ロボットRBTは、旋回用のモータMθにより駆動され
るギアGEと、このギアGEと共に回転するガイドポー
ルGPと、このガイドポールGPによって案内され、モ
ータMZによって駆動されるねじSCZにより上下方向
に移動するキャリッジCARと、このキャリッジCAR
に取付けられたモータMRによりバンドHNDを有する
アームARMが水平方向に移動する機構とを有し、且つ
各モータMθ、MZ、MRにはパルスコーダPCθ、P
CZ 、PCRが結合されている。
ロボットRBTは、旋回用のモータMθにより駆動され
るギアGEと、このギアGEと共に回転するガイドポー
ルGPと、このガイドポールGPによって案内され、モ
ータMZによって駆動されるねじSCZにより上下方向
に移動するキャリッジCARと、このキャリッジCAR
に取付けられたモータMRによりバンドHNDを有する
アームARMが水平方向に移動する機構とを有し、且つ
各モータMθ、MZ、MRにはパルスコーダPCθ、P
CZ 、PCRが結合されている。
工作機械は、ワークW1を取付けるチャックCHKを回
転する主軸モータSPMと、X方向に工具台を送る送り
ねじSCXとその駆動用のモータMXと、工具台をY方
向に送るねじSCYとその駆動用のモータMYと、工具
TLの破損を検出するランプLMPと光検出器PDと機
械操作盤MOPとを有するものである。
転する主軸モータSPMと、X方向に工具台を送る送り
ねじSCXとその駆動用のモータMXと、工具台をY方
向に送るねじSCYとその駆動用のモータMYと、工具
TLの破損を検出するランプLMPと光検出器PDと機
械操作盤MOPとを有するものである。
又コンベアベル1−CVBによって搬送されるワークW
2.W3はワークの種類を示すコード板C2,C3を有
するパレット上に載置され、コード板C2,C3を読取
る為のリミットスイッチLSWが配置されている。
2.W3はワークの種類を示すコード板C2,C3を有
するパレット上に載置され、コード板C2,C3を読取
る為のリミットスイッチLSWが配置されている。
このコンベアベルトCVBはモータCVMによって駆動
される。
される。
加工済みのワークWA、WBは収納棚にロボツ)RBT
により載置される。
により載置される。
又DVX、DVY、DVS 、DVCはモータMX、M
Y、SPM、CVMの駆動回路、ID1゜ID2は異常
状態をモータの負荷電流の検出で識別する為の電流検出
器、NCは工作機械を制御する為の数値制御装置であり
、wsはワーク種別信号、tsは工具破損信号、lsは
機械操作盤MOPからの不良ワーク信号、spmは主軸
モータ異常信号、svsはサーボ異常信号、OP 、
CL 。
Y、SPM、CVMの駆動回路、ID1゜ID2は異常
状態をモータの負荷電流の検出で識別する為の電流検出
器、NCは工作機械を制御する為の数値制御装置であり
、wsはワーク種別信号、tsは工具破損信号、lsは
機械操作盤MOPからの不良ワーク信号、spmは主軸
モータ異常信号、svsはサーボ異常信号、OP 、
CL 。
ROはハンドHNDの開閉及び回転指令信号である。
ロボットRBTのハンドHNDにより工具TLの交換や
チャックCHKへのワークの取付け、取外しが行なわれ
るもので、例えばワークW1の加工終了によりチャック
CHKから取外し、次のワークW2をチャックCHKに
取付けるとき、リミットスイッチLSWによりワークW
2の種類を示すコード板C2に対応したワーク種別信号
wsが読取られる。
チャックCHKへのワークの取付け、取外しが行なわれ
るもので、例えばワークW1の加工終了によりチャック
CHKから取外し、次のワークW2をチャックCHKに
取付けるとき、リミットスイッチLSWによりワークW
2の種類を示すコード板C2に対応したワーク種別信号
wsが読取られる。
なおワークの種別は他の任意の読取手段を採用すること
ができるものである。
ができるものである。
又工作機械の数値制御装置NCによる制御は既に知られ
ている任意の方式で行なうことができるので詳細な説明
は省略する。
ている任意の方式で行なうことができるので詳細な説明
は省略する。
第2図は本発明の実施例のブロック線図であり、MZ、
Mθ、MR及びPCZ、PCθ、PCRは第1図に示す
ロボットRBTのモータ及びパルスコーダ、MOPは機
械操作盤、CPUはプロセッサ、ABはアドレスバス、
DBはデータバス、WMはワークメモリ、CPMはコン
トロールプログラムメモリ、TDMは教示データメモリ
、TOPは教示操作盤、PZ、Pθ、PRは位置制御ユ
ニット、DOはデータ出力部、DIはデータ入力部、E
CDは工/コーダ、INTはインクポレータ、ERはエ
ラーレジスタ、G1.G2はゲート回路、DAはDA変
換器、FVCは速度電圧変換器、■は速度制御ユニット
、RLYは軸選択信号SZ。
Mθ、MR及びPCZ、PCθ、PCRは第1図に示す
ロボットRBTのモータ及びパルスコーダ、MOPは機
械操作盤、CPUはプロセッサ、ABはアドレスバス、
DBはデータバス、WMはワークメモリ、CPMはコン
トロールプログラムメモリ、TDMは教示データメモリ
、TOPは教示操作盤、PZ、Pθ、PRは位置制御ユ
ニット、DOはデータ出力部、DIはデータ入力部、E
CDは工/コーダ、INTはインクポレータ、ERはエ
ラーレジスタ、G1.G2はゲート回路、DAはDA変
換器、FVCは速度電圧変換器、■は速度制御ユニット
、RLYは軸選択信号SZ。
Sθ、SRを出力する為のリレーである。
ワークメモリWMのレジスタ領域R1〜R3にはロボッ
トの現在位置Zi、θi、R1がセットされ、レジスタ
領域R4には教示位置ZiH,θi+1゜Ri+1がセ
ットされ、移動量の演算結’LdZ、11θ、JRがレ
ジスタ領域R5にセットされ、ロボットの制御の為のデ
ータの加算結果Σがレジスタ領域R6にセットされる。
トの現在位置Zi、θi、R1がセットされ、レジスタ
領域R4には教示位置ZiH,θi+1゜Ri+1がセ
ットされ、移動量の演算結’LdZ、11θ、JRがレ
ジスタ領域R5にセットされ、ロボットの制御の為のデ
ータの加算結果Σがレジスタ領域R6にセットされる。
又レジスタ領域R10にはワーク種別a。b、c等の外
部データがセットされ、レジスタ領域R11にはワーク
加工残数m、レジスタ領域R12にはワーク不良発生数
Pがセットされる。
部データがセットされ、レジスタ領域R11にはワーク
加工残数m、レジスタ領域R12にはワーク不良発生数
Pがセットされる。
ロボットRBTのハンドHNDが原点にあるものとして
、教示の手順について説明する。
、教示の手順について説明する。
教示操作盤TOPのモードスイッチMSを教示モードT
とし、数値キーNKによりO(或は操作せず)として送
り速度教示釦FBを押す。
とし、数値キーNKによりO(或は操作せず)として送
り速度教示釦FBを押す。
これによってプロセッサCPUの制御の下で教示データ
メモリTDMのアドレスOOのF領域に0が書込まれる
。
メモリTDMのアドレスOOのF領域に0が書込まれる
。
この教示データメモIJTDMは例えば第3図に示すよ
うに、各アドレス毎に、F、Z、θ、R,Sの領域を有
するものである。
うに、各アドレス毎に、F、Z、θ、R,Sの領域を有
するものである。
次に軸データ教示釦TBを押す。
これによってハンドHNDの現在位置Zi、θi 、R
iが教示データメモリTDMのアドレスOOのZ、θ、
R領域にワークメモリWMのレジスタ領域R1〜R3か
ら転送されて書込まれる。
iが教示データメモリTDMのアドレスOOのZ、θ、
R領域にワークメモリWMのレジスタ領域R1〜R3か
ら転送されて書込まれる。
次に858 (10)を入力する。
即ち数値キーNKにより58を入力し、押釦SBを押し
、再び数値キーNKにより10を入力して押釦SBを押
す。
、再び数値キーNKにより10を入力して押釦SBを押
す。
その結果アドレスOOのS領域に858 (10)が書
込まれる。
込まれる。
次に送り速度教示釦FBを押すと、数値Oがアドレス0
1のF領域に書込まれ、次に軸データ教示釦TBを押す
と、ハンドHNDの現在位置Zi)θi、Riがアドレ
ス01のZ、θ、R領域に書込まれる。
1のF領域に書込まれ、次に軸データ教示釦TBを押す
と、ハンドHNDの現在位置Zi)θi、Riがアドレ
ス01のZ、θ、R領域に書込まれる。
次に851 (7) (5) (10)を入力する。即
ち数値キーNKで51を入力して押釦SBを押し、数値
キーNKで7を入力して押釦SBを押し、同様にして5
,10を入力する毎に押釦SBを押す。
ち数値キーNKで51を入力して押釦SBを押し、数値
キーNKで7を入力して押釦SBを押し、同様にして5
,10を入力する毎に押釦SBを押す。
それによってアドレス01に851 (7) (5)(
10)が書込まれる。
10)が書込まれる。
なおSコードの一例を説明すると、SOOはSコード終
了、809はロフト完了即ちロボットの動作の終了を示
し、スタートにプログラムが戻らないと動作しないこと
を示す。
了、809はロフト完了即ちロボットの動作の終了を示
し、スタートにプログラムが戻らないと動作しないこと
を示す。
811はハンド指全開、812はハンド指間、S 25
(T)はTで指定された時間だけドウエルを行なうタ
イマ、837は工作機械加工開始、S 50 (A)は
アドレスAへの分岐、S 51 (N) (A) (R
)はレジスタ領域Rの内容がNのときアドレスAへ、そ
の他は次のアドレスへ進むことを示す。
(T)はTで指定された時間だけドウエルを行なうタ
イマ、837は工作機械加工開始、S 50 (A)は
アドレスAへの分岐、S 51 (N) (A) (R
)はレジスタ領域Rの内容がNのときアドレスAへ、そ
の他は次のアドレスへ進むことを示す。
S 52 (N) (R)はレジスタ領域Rの内容をN
だけ増減、S 53 (N) (R)はレジスタ領域R
にNを設定、S 58 (R)はレジスタ領域Rに外部
データを読込んでセットすることを示す。
だけ増減、S 53 (N) (R)はレジスタ領域R
にNを設定、S 58 (R)はレジスタ領域Rに外部
データを読込んでセットすることを示す。
又S99はプログラム終了を示す。ワークに対する教示
については、手動送り釦JZ、Jθ、JRを順次押して
バンドHNDを所定の位置に移動させ、送り速度を数値
キーNKで入力して送り速度教示釦FBを押す。
については、手動送り釦JZ、Jθ、JRを順次押して
バンドHNDを所定の位置に移動させ、送り速度を数値
キーNKで入力して送り速度教示釦FBを押す。
それによってアドレス06のF領域に送り速度が書込ま
れる。
れる。
又軸データ教示釦TBを押すと、バンドHNDの手動送
りによる現在位置がアドレス06のZ、θ。
りによる現在位置がアドレス06のZ、θ。
R領域に書込まれる。
バンドHNDの開閉、回転等の補助動作が必要のときは
、更にSコードを人力する。
、更にSコードを人力する。
次に手動送り釦JZ、Jθ、JRを順次押して前述と同
様に教示データをアドレスO7に書込む。
様に教示データをアドレスO7に書込む。
このようにしてロボットRBTの動作を規定する教示デ
ータを教示データメモIJTDMに書込み、次にモード
スイッチMSをレジスタ記憶モードRGにセットし、数
値キーNKでワークメモリWMのレジスタ領域R11を
示す11を入力し、レジスタ設定用釦RBを押し、加工
すべきワークの個数を数値キーNKで入力し、レジスタ
設定用釦RBを押す。
ータを教示データメモIJTDMに書込み、次にモード
スイッチMSをレジスタ記憶モードRGにセットし、数
値キーNKでワークメモリWMのレジスタ領域R11を
示す11を入力し、レジスタ設定用釦RBを押し、加工
すべきワークの個数を数値キーNKで入力し、レジスタ
設定用釦RBを押す。
それによってレジスタR11に初期値としての個数がセ
ットされる。
ットされる。
教示データメモIJTDMの内容が例えば第1表に示す
ようにセットされたとすると、モードスイッチMSをレ
ピート動作モードRPにセットし、スタート釦STAを
押すことによりロボットRBTの動作が開始される。
ようにセットされたとすると、モードスイッチMSをレ
ピート動作モードRPにセットし、スタート釦STAを
押すことによりロボットRBTの動作が開始される。
このスタート釦STAを押すことによって教示データメ
モIJTDMの内容が順次プロセッサにより読取られる
もので、先ずアドレス00の内容が読取られる。
モIJTDMの内容が順次プロセッサにより読取られる
もので、先ずアドレス00の内容が読取られる。
このアドレス00のF領域は0、Z、θ、R領域は原点
位置を示し、ロボットのバンドHNDが原点位置にある
ので、ロボットRBTの動作はなく、外部データの読込
みが行なわれる。
位置を示し、ロボットのバンドHNDが原点位置にある
ので、ロボットRBTの動作はなく、外部データの読込
みが行なわれる。
外部データはデータ入力部DIを介して読取られるもの
で、ワーク種別a ” cは0〜2、ワーク不良発生は
6、工具破損等の異常状態は7となるようにエンコーダ
ECDでコード化されて読取られる。
で、ワーク種別a ” cは0〜2、ワーク不良発生は
6、工具破損等の異常状態は7となるようにエンコーダ
ECDでコード化されて読取られる。
この読取内容はワークメモリWMのレジスタ領域R10
にセットされる。
にセットされる。
次にアドレス01の内容が読出され、Sコードのみの実
行が行なわれる。
行が行なわれる。
このアドレス01に歩進したとき、レジスタ領域RIO
の内容が7ならば異常状態であるから次はアドレス05
にとんでロフト完了、プログラム終了となる。
の内容が7ならば異常状態であるから次はアドレス05
にとんでロフト完了、プログラム終了となる。
異常状態でなければ次のアドレス02に歩進し、レジス
タ領域RIOの内容がOでワーク種別がaであることを
示すと、次はアドレス06にとぶことになる。
タ領域RIOの内容がOでワーク種別がaであることを
示すと、次はアドレス06にとぶことになる。
又ワーク種別がaでなければ次のアドレス03に歩進す
る。
る。
このアドレス03及び次のアドレス04に於いても同様
の動作が行なわれる。
の動作が行なわれる。
アドレス06以降ではワークaの着脱プログラムP1が
実行されるもので、Z軸については、現在位置Ziと教
示位置Zi+1と教示送り速度Fとを用いて (Zi++ Zi)XF/n=JZ ・・−・・・
・・・(1)の演算を行ない、この、(Zを一定周期で
位置制御ユニットPZへ出力する。
実行されるもので、Z軸については、現在位置Ziと教
示位置Zi+1と教示送り速度Fとを用いて (Zi++ Zi)XF/n=JZ ・・−・・・
・・・(1)の演算を行ない、この、(Zを一定周期で
位置制御ユニットPZへ出力する。
そしてこのJZを出力する度にZi+JZを演算してワ
ークメモIJWMのレジスタ領域R6にセットする。
ークメモIJWMのレジスタ領域R6にセットする。
このレジスタ領域R6の内容Σが教示位置Zi+1に等
しくなるまで繰返す。
しくなるまで繰返す。
位置制御ユニットPZでは、一定周期でJZをインクポ
レータINTに書込むもので、このインクポレータIN
Tは1つの基準パルス列発生器とプリセットカウンタと
を備え、前記一定周期内でAZをパルス列に変換してエ
ラーレジスタBRへ加える。
レータINTに書込むもので、このインクポレータIN
Tは1つの基準パルス列発生器とプリセットカウンタと
を備え、前記一定周期内でAZをパルス列に変換してエ
ラーレジスタBRへ加える。
このエラーレジスタERにはパルスコーダPCZからの
パルスがフィードバックされて内容の減算が行なわれ、
エラーレジスタERの内容はゲート回路G1を介してD
A変換器DAに加えられ、アナログ電圧に変換される。
パルスがフィードバックされて内容の減算が行なわれ、
エラーレジスタERの内容はゲート回路G1を介してD
A変換器DAに加えられ、アナログ電圧に変換される。
又フィードバックパルスはゲート回路G1を介して速度
電圧変換器FVCに加えられ、速度電圧に変換される。
電圧変換器FVCに加えられ、速度電圧に変換される。
速度制御ユニツ1−VUはエラーレジスタERの内容を
アナログ電圧とした誤差電圧と速度電圧とにより、サイ
リスクの点弧制御等を行ない、ゲート回路G2を介して
モータMZを駆動する。
アナログ電圧とした誤差電圧と速度電圧とにより、サイ
リスクの点弧制御等を行ない、ゲート回路G2を介して
モータMZを駆動する。
従って教示位置Zi+1にキャリッジCARが移動され
ることになる。
ることになる。
モータMθ、MRの制御についても前述と同様にして行
なわれる。
なわれる。
又軸の切換えは、データ出力部DOに軸データが加えら
れ、リレーRLYにより軸選択信号SZ、Sθ、SRが
形成されてゲート回路G1.G2に加えられ、軸選択信
号に従って切換制御が行なわれる。
れ、リレーRLYにより軸選択信号SZ、Sθ、SRが
形成されてゲート回路G1.G2に加えられ、軸選択信
号に従って切換制御が行なわれる。
又Sコードによりバンド指開信号OP、バンド指閉信号
CL、バンド回転信号RO等が指令されると、データ出
力部DOからバンドHNDの操作部にそれらの信号が加
えられる。
CL、バンド回転信号RO等が指令されると、データ出
力部DOからバンドHNDの操作部にそれらの信号が加
えられる。
前述の如きプログラムP1の実行が行なわれてアドレス
15に歩進すると、次はアドレス36へ分岐し、外部デ
ータの読込みを行ない、アドレス37の内容による実行
結果ワーク不良が検出されなければ次のアドレス38の
内容の実行によりワークメモリWMのレジスタ領域R1
1の内容を−1し、次はアドレス40の内容の実行を行
ない、加工残数がOでなければアドレス41の内容の実
行により機械加工開始指令が出力され、数値制御装置N
Cによる工作機械の制御が開始される。
15に歩進すると、次はアドレス36へ分岐し、外部デ
ータの読込みを行ない、アドレス37の内容による実行
結果ワーク不良が検出されなければ次のアドレス38の
内容の実行によりワークメモリWMのレジスタ領域R1
1の内容を−1し、次はアドレス40の内容の実行を行
ない、加工残数がOでなければアドレス41の内容の実
行により機械加工開始指令が出力され、数値制御装置N
Cによる工作機械の制御が開始される。
又ワーク不良品が生じると、機械操作部MOPからデー
タ入力部DIに不良ワーク信号lsが入力され、外部デ
ータ読取時にワークメモIJWMのレジスタ部R10に
6がセットされ、教示データメモIJTDMのアドレス
37の内容の実行によりアドレス39に分岐し、ワーク
メモリWMのレジスタR12に+1する。
タ入力部DIに不良ワーク信号lsが入力され、外部デ
ータ読取時にワークメモIJWMのレジスタ部R10に
6がセットされ、教示データメモIJTDMのアドレス
37の内容の実行によりアドレス39に分岐し、ワーク
メモリWMのレジスタR12に+1する。
このとき加工残数は減算されないので、加工残数が0に
なるまで制御が繰返されることにより、指定された個数
の良品加工ワークが得られることになる。
なるまで制御が繰返されることにより、指定された個数
の良品加工ワークが得られることになる。
以上説明したように、本発明は、教示操作盤TOPより
教示データを教示データメモIJTDMにセットし、ロ
ボットRBTの現在位置Zitθi。
教示データを教示データメモIJTDMにセットし、ロ
ボットRBTの現在位置Zitθi。
Ri及び教示位置Zi+1.θi+1.Ri+1のデー
タ、ワーク種別やワーク不良信号、加工すべきワークの
個数をワークメモリWMにセットし、プロセッサCPU
の制御により教示データメモIJTDM及びワークメモ
IJWMの内容を読出して、必要に応じて演算し、教示
データメモIJTDMの内容に従ってロボットを制御し
、又外部データを読込んだことにより教示データの変更
或は教示データによるシーケンスの変更を行なうもので
あり、ワークの種別に対応した制御やワーク不良発生時
の加工すべきワーク個数の変更を容易に行なうことがで
きる。
タ、ワーク種別やワーク不良信号、加工すべきワークの
個数をワークメモリWMにセットし、プロセッサCPU
の制御により教示データメモIJTDM及びワークメモ
IJWMの内容を読出して、必要に応じて演算し、教示
データメモIJTDMの内容に従ってロボットを制御し
、又外部データを読込んだことにより教示データの変更
或は教示データによるシーケンスの変更を行なうもので
あり、ワークの種別に対応した制御やワーク不良発生時
の加工すべきワーク個数の変更を容易に行なうことがで
きる。
従って複数種類のワークが混在している場合に於いても
、順次ワーク種別に対応した制御を実行することができ
る。
、順次ワーク種別に対応した制御を実行することができ
る。
又ワーク種別は前述の実施例の如くワークを載置するパ
レットにコード板等を取付けることにより容易に読取る
ことが可能である。
レットにコード板等を取付けることにより容易に読取る
ことが可能である。
第1図はロボットと工作機械との説明図、第2図は本発
明の実施例のブロック線図、第3図は教示メモリの領域
説明図である。 RBTはロボット、MZ 、Mθ、MRはモータ、HN
Dはバンド、W1〜W3はワーク、C2゜C3はコード
板、LSWはリミットスイッチ、NCは数値制御装置、
CPUはプロセッサ、WMはワークメモリ、TDMは教
示データメモリ、TOPは教示操作盤、DIはデータ入
力部、DOはデータ出力部、CPMはコントロールプロ
グラムメモリ、PZ、Pθ、PRは位置制御ユニット、
VUは速度制御ユニットである。
明の実施例のブロック線図、第3図は教示メモリの領域
説明図である。 RBTはロボット、MZ 、Mθ、MRはモータ、HN
Dはバンド、W1〜W3はワーク、C2゜C3はコード
板、LSWはリミットスイッチ、NCは数値制御装置、
CPUはプロセッサ、WMはワークメモリ、TDMは教
示データメモリ、TOPは教示操作盤、DIはデータ入
力部、DOはデータ出力部、CPMはコントロールプロ
グラムメモリ、PZ、Pθ、PRは位置制御ユニット、
VUは速度制御ユニットである。
Claims (1)
- 1 教示操作盤から入力されたワーク種別毎及びワーク
不良発生時のロボットの動作を指示する教示データをセ
ットする教示データメモリと、ワークの種別を判別する
ワーク種別読取り手段からのワーク種別情報、機械操作
部からのワーク不良信号、加工すべきワークの個数、ロ
ボットの現在位置データ、教示位置データ等をセットす
るワークメモリと、前記教示データメモリ及びワークメ
モリの書込み、読出し制御並びに演算を行なうプロセッ
サとを備え、前記教示データメモリに記憶された前記ワ
ーク種別情報に対応する教示データの内容に従ってロボ
ットの制御を実行し、且つ前記ワーク不良信号が入力さ
れたときは、前記ワークメモリの加工すべきワークの個
数を1ワ一ク分増加することを特徴とする産業用ロボッ
トの制御方式。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP53049413A JPS5858682B2 (ja) | 1978-04-26 | 1978-04-26 | 産業用ロボツトの制御方式 |
US06/029,851 US4347578A (en) | 1978-04-26 | 1979-04-13 | Industrial robot control system |
GB7914044A GB2021287B (en) | 1978-04-26 | 1979-04-23 | Industrial robot control apparatus |
DE19792916702 DE2916702A1 (de) | 1978-04-26 | 1979-04-25 | Steuerung fuer einen industrieroboter |
FR7910618A FR2424579A1 (fr) | 1978-04-26 | 1979-04-26 | Dispositif de commande pour un robot industriel |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP53049413A JPS5858682B2 (ja) | 1978-04-26 | 1978-04-26 | 産業用ロボツトの制御方式 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS54142771A JPS54142771A (en) | 1979-11-07 |
JPS5858682B2 true JPS5858682B2 (ja) | 1983-12-27 |
Family
ID=12830364
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP53049413A Expired JPS5858682B2 (ja) | 1978-04-26 | 1978-04-26 | 産業用ロボツトの制御方式 |
Country Status (5)
Country | Link |
---|---|
US (1) | US4347578A (ja) |
JP (1) | JPS5858682B2 (ja) |
DE (1) | DE2916702A1 (ja) |
FR (1) | FR2424579A1 (ja) |
GB (1) | GB2021287B (ja) |
Families Citing this family (39)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5621794A (en) * | 1979-07-30 | 1981-02-28 | Fujitsu Fanuc Ltd | Controlling system for industrial robot |
US4420812A (en) * | 1979-09-14 | 1983-12-13 | Tokico, Ltd. | Teaching- playback robot |
AU6339680A (en) * | 1979-10-02 | 1981-04-28 | Daihatsu Motor Co. Ltd. | Method of controlling numerical controlled machine tool |
JPS56152002A (en) * | 1980-04-24 | 1981-11-25 | Heian Tekkosho:Kk | Setup controller of machine tool |
JPS5785674A (en) * | 1980-11-17 | 1982-05-28 | Komatsu Ltd | Copying corrector for welding robot |
DE3169292D1 (en) * | 1980-11-17 | 1985-04-18 | Hitachi Ltd | Assembling or processing system |
JPS57113117A (en) * | 1980-12-30 | 1982-07-14 | Fanuc Ltd | Robot control system |
JPS57113118A (en) * | 1980-12-30 | 1982-07-14 | Fanuc Ltd | Robot control system |
JPS57113111A (en) * | 1980-12-30 | 1982-07-14 | Fanuc Ltd | Robot control system |
US4403281A (en) * | 1981-04-03 | 1983-09-06 | Cincinnati Milacron Industries, Inc. | Apparatus for dynamically controlling the tool centerpoint of a robot arm off a predetermined path |
US4545106A (en) * | 1981-04-30 | 1985-10-08 | Gte Valeron Corporation | Machine system using infrared telemetering |
JPS57207908A (en) * | 1981-06-17 | 1982-12-20 | Hitachi Ltd | Robot controller |
JPS5822412A (ja) * | 1981-08-04 | 1983-02-09 | Fanuc Ltd | 工業用ロボツト制御方式 |
JPS58117004A (ja) * | 1981-12-30 | 1983-07-12 | Fanuc Ltd | ロボツト制御方式 |
JPS58141867A (ja) * | 1982-02-19 | 1983-08-23 | Kiyouhou Seisakusho:Kk | ロボツト用関連作動軸の制御方法 |
JPS58149189A (ja) * | 1982-03-01 | 1983-09-05 | セイコーインスツルメンツ株式会社 | 工業用ロボツトの旋回昇降機構 |
JPS58177289A (ja) * | 1982-04-12 | 1983-10-17 | 株式会社三協精機製作所 | 工業用ロボツトの動作制御装置 |
SE452719B (sv) * | 1982-06-29 | 1987-12-14 | Asea Ab | Industrirobot |
JPS5927307A (ja) * | 1982-08-04 | 1984-02-13 | Hitachi Ltd | 経路制御方法及び装置 |
US4608714A (en) * | 1982-09-03 | 1986-08-26 | Gte Valeron Corporation | Low battery detector for a machine system using infrared telemetry |
CA1184273A (en) * | 1982-09-23 | 1985-03-19 | Kazuyoshi Yasukawa | Robot control apparatus |
JPS5977509A (ja) * | 1982-10-05 | 1984-05-04 | Fujitsu Ltd | ロボツト制御方式 |
FR2541561B1 (fr) * | 1983-02-28 | 1986-05-09 | Renault | Dispositif de commande automatique de liage dans une presse a fourrage |
SE455387B (sv) * | 1983-04-08 | 1988-07-11 | Asea Ab | Sett och anordning for styrning av en svetsrobot med hjelp av ett flerfunktionsmanoverorgan (styrspak) samt anvendning av ett dylikt manoverorgan |
JPS6033607A (ja) * | 1983-08-05 | 1985-02-21 | Nachi Fujikoshi Corp | ロボツトの補間動作制御装置 |
DE3379430D1 (en) * | 1983-12-24 | 1989-04-20 | Schuler Gmbh L | Device for determining the desired transportation reference of a work piece in a multiple-step press |
US4638227A (en) * | 1984-01-18 | 1987-01-20 | Hitachi, Ltd. | Method and apparatus for recovering normality in moving sequence of machinery |
KR900008539B1 (ko) * | 1985-05-30 | 1990-11-24 | 마쯔시다덴기산교 가부시기가이샤 | 로보트의 연속경로 제어방법 |
JPS6293710A (ja) * | 1985-10-18 | 1987-04-30 | Tokico Ltd | 工業用ロボツト |
US4973215A (en) * | 1986-02-18 | 1990-11-27 | Robotics Research Corporation | Industrial robot with servo |
US4869813A (en) * | 1987-07-02 | 1989-09-26 | Northrop Corporation | Drill inspection and sorting method and apparatus |
JPH0738907B2 (ja) * | 1988-08-20 | 1995-05-01 | ブラザー工業株式会社 | 縫製システム |
US5049796A (en) * | 1989-05-17 | 1991-09-17 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Robust high-performance control for robotic manipulators |
GB2259586B (en) * | 1991-09-11 | 1994-08-24 | Honda Motor Co Ltd | Method of and system for generating teaching data for robots |
US5475797A (en) * | 1993-10-22 | 1995-12-12 | Xerox Corporation | Menu driven system for controlling automated assembly of palletized elements |
JP3529158B2 (ja) * | 1994-05-18 | 2004-05-24 | ファナック株式会社 | ロボット動作プログラミング方法及びプログラミング装置 |
US8078445B2 (en) * | 2008-09-30 | 2011-12-13 | Rockwell Automation Technologies, Inc. | Load characterization in servo drive systems |
CN109335589A (zh) * | 2018-11-15 | 2019-02-15 | 陈国� | 工件传送流水线的控制方法 |
CN113894778B (zh) * | 2021-07-19 | 2022-08-12 | 北京精密机电控制设备研究所 | 一种用于灵巧手伺服系统及其故障检测、控制保护方法 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3306442A (en) * | 1964-11-02 | 1967-02-28 | George C Devol | Multi-program apparatus |
BE694674A (ja) * | 1967-02-27 | 1967-07-31 | ||
US4021651A (en) * | 1972-06-20 | 1977-05-03 | Kawasaki Jukogyo Kabushiki Kaisha | Programmed manipulator |
US3920972A (en) * | 1974-07-16 | 1975-11-18 | Cincinnati Milacron Inc | Method and apparatus for programming a computer operated robot arm |
IT1043940B (it) * | 1974-12-20 | 1980-02-29 | Fiat Spa | Apparecchaitura per il controllo di una macchina operatrice del tipo robot |
US4025838A (en) * | 1974-12-26 | 1977-05-24 | Kawasaki Heavy Industries, Ltd. | Signal modification device for memory controlled manipulator apparatus |
USRE30016E (en) | 1975-09-12 | 1979-05-29 | Cincinnati Milacron Inc. | Method and apparatus for compensating for unprogrammed changes in relative position between a machine and workpiece |
US4140953A (en) * | 1976-03-03 | 1979-02-20 | Unimation, Inc. | Real time program modification apparatus |
DE2731041C3 (de) * | 1976-07-09 | 1981-04-02 | Régie Nationale des Usines Renault, Boulogne-Billancourt, Hauts-de-Seine | Programmiervorrichtung für eine programmgesteuerten Anstrichmanipulator |
US4178632A (en) * | 1978-03-06 | 1979-12-11 | Cincinnati Milacron Inc. | Method for controlling the operation of a computer operated robot arm |
-
1978
- 1978-04-26 JP JP53049413A patent/JPS5858682B2/ja not_active Expired
-
1979
- 1979-04-13 US US06/029,851 patent/US4347578A/en not_active Expired - Lifetime
- 1979-04-23 GB GB7914044A patent/GB2021287B/en not_active Expired
- 1979-04-25 DE DE19792916702 patent/DE2916702A1/de not_active Ceased
- 1979-04-26 FR FR7910618A patent/FR2424579A1/fr active Granted
Also Published As
Publication number | Publication date |
---|---|
DE2916702A1 (de) | 1979-10-31 |
JPS54142771A (en) | 1979-11-07 |
GB2021287A (en) | 1979-11-28 |
FR2424579A1 (fr) | 1979-11-23 |
US4347578A (en) | 1982-08-31 |
FR2424579B1 (ja) | 1984-02-17 |
GB2021287B (en) | 1982-12-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPS5858682B2 (ja) | 産業用ロボツトの制御方式 | |
US4348623A (en) | Numerical control system for controlling both a machine tool and a robot | |
JP3665008B2 (ja) | 同期制御方法及び同期制御装置 | |
WO1988008559A1 (en) | Numerical control device | |
CN109304717A (zh) | 机器人控制装置以及生产系统 | |
JPH046001B2 (ja) | ||
JPS6315604B2 (ja) | ||
WO1989006066A1 (en) | Method of speed control for servomotor | |
GB2083247A (en) | A programmable machine | |
JPH04155406A (ja) | 制御方法 | |
JPS61131105A (ja) | 刃物台を2台有する旋盤の制御方式 | |
KR820001952B1 (ko) | 산업용 로보트의 제어시스템 | |
JPS63311408A (ja) | 数値制御装置 | |
WO1989001388A1 (en) | Axis switching device | |
WO2004048049A1 (ja) | 自動機械の制御装置及び制御方法 | |
JPH09305213A (ja) | ロボット制御装置 | |
JP2008130013A (ja) | 数値制御装置 | |
JP3433817B2 (ja) | 送り制御装置 | |
KR910009240B1 (ko) | 수치제어장치 | |
JPS58171242A (ja) | 適応制御機能付nc装置 | |
JPH0628837B2 (ja) | 原位置復帰機能を備えた工作機械 | |
JPH0421202B2 (ja) | ||
JP2556963Y2 (ja) | 数値制御装置 | |
JPH05131340A (ja) | Nc加工機の原点復帰方法 | |
JPH0421201B2 (ja) |