JPS60144806A - ロボツトのライントラツキング制御方法 - Google Patents

ロボツトのライントラツキング制御方法

Info

Publication number
JPS60144806A
JPS60144806A JP59000745A JP74584A JPS60144806A JP S60144806 A JPS60144806 A JP S60144806A JP 59000745 A JP59000745 A JP 59000745A JP 74584 A JP74584 A JP 74584A JP S60144806 A JPS60144806 A JP S60144806A
Authority
JP
Japan
Prior art keywords
robot
speed
time
conveyor
control method
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP59000745A
Other languages
English (en)
Inventor
Seiichiro Nakajima
中島 清一郎
Kenichi Toyoda
豊田 賢一
Nobutoshi Torii
信利 鳥居
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.)
Fanuc Corp
Original Assignee
Fanuc 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 Fanuc Corp filed Critical Fanuc Corp
Priority to JP59000745A priority Critical patent/JPS60144806A/ja
Publication of JPS60144806A publication Critical patent/JPS60144806A/ja
Pending 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] or 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] or computer integrated manufacturing [CIM] characterised by the cooperation between machine tools, manipulators and conveyor or other workpiece supply system, workcell
    • G05B19/4182Total 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 manipulators and conveyor only
    • 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]

Landscapes

  • Engineering & Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Quality & Reliability (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 技術分野 本発明はロボットの動作制御方法に関し、特にコンベア
等の運搬手段によって定速度で直線搬送されるワーク、
パレット等の対象物に対して定位置に設置されたロボッ
トの動作部を追跡走行させ、所定の位置で当該対象物に
所定のロボット作業を遂行せしめるように制御するロボ
ットのライントラッキング制御方法に関する。
従来技術 ]ンベアによって直線搬送されるワーク等の対象物にロ
ボットハンドを有したロボット動作部を追走させて該対
象物に所望のロボット作業を遂行させるようにロボッI
f制御する所謂、ライントラッキング制御は従来からお
こなわれている。
この従来のライントラッキング制御においては。
コンベア上の被対象物全光電変換手段等の検出器で検出
し、検出時点からロボット動作部をコンベア走行方向に
加速走行させ、コンベアと同速度に到達、併走させなが
ら被対象物に所望のロボット作業を遂行させるような制
御方法が採られていた。
この方法によると、コンベア上の対象物を検出した時点
から、ロボット動作部の加速が開始される徒でに遅れ時
間があり、また加速時間中におけるコンベア上の対象物
の移動距離とロボット動作部の走行距離(つまり、速度
の積分け)との間には差があるという両者の原因によっ
て、ロボット動作部が精密に対象物に所望のロボット作
業を付与するようにするためには検出器の設定信性を試
行錯誤的に修正調整しなければならず、ロボットの制御
装置側で修正処理することはできないという欠点を有し
ていた。
発明の概要 依って、不発明の目的は、ロボットのライントラッキン
グ制御に当って、運搬手段によって搬送される対象物の
通過と運搬手段の走行速度との両者をロボット制御装置
の入力として、定置されたロボットのロボy)動作部を
所定の位置で対象物に到達1M逅せしめ、所望のロボッ
ト作業を遂行させるようにしたライントランキング制御
方法を提供せんとするものである。
すなわち1本発明によれば、定方向に略定速度でライン
走行するコンベア手段上の対象物をロボット動作部によ
って追走し、V対象物に所定のロボット作業全遂行させ
るロボットのライントラッキング制御方法において、前
記コンベア手段の走行速度と前記コンベア手段のライン
走行路の一定位置におQyる前記対象物の通過とを検出
し1通過したときに前記ロボット動作部を駆動して前記
コンベア手段の走1行速度より高速度まで加速移動させ
1次いでその高速度で定速ライン走行させることによっ
て所定の位置で前記対象物に到達邂逅させるようにした
ことを特徴とするロボットのライントラッキング制御方
法が提供され、このとき前記ロボット動作部は前記コン
ベア手段上の対象物に到達邂逅したとき、該コンベア手
段の走行方向に同期ライン走行するように減速制御され
る。このように構成すれば、コンベア手段の走行速度が
高速の場合にも、その走行速度を超過した高速度でロボ
ット動作部が走行する走行モードを有するので、ロボッ
ト動作部が確実にコンベア手段上の対象物と対面して所
望のロボット作業を付与することができる。以下1本発
明を添付図面に示した実施例に基いて詳細に説明する。
第1図は本発明によるロボットのライントラッキング制
御方法を実施するだめのシスゾムを示しており、同第1
図において、定位置に固定設置されたロボット10は、
ロボット作業用のハンド14を有した多関節腕12をロ
ボット動作部として具備し、矢印mA“で示す一定の方
向にだ速度■oで走行するコンベア16と対向配置され
ている。このコンベア16上VCはワーク自体又はワー
ク取付用パレット等の対象物18が載置され、この対象
物16は例えば発光器20a、受光器20bによって形
成される光電式検出器等の通過検出手段によって一定位
置18aを通過した後に他の定位置18bに達したとき
、ロボット動作部のノ1ンド14から例えば他のワーク
片の嵌合操作を受ける等のロボット作業を付与されるの
である。そして1通過検出手段の受光器20bからはロ
ボット制御装@22に検出信号が入力されており、また
コンベア16の走行速度■0ヲ検出する例えばパルスエ
ンコーダ24による速度検出信号がロボット制御装置2
2にフィードバック回路を介して入力される。この場合
に1本発明の実施においては。
パルスエンコーダ、タコジェネレータ等の速度検出器2
4の速度検出信号はロボット制御装置22における駆動
モータフィードバック信号の受信チャンネルにおける1
つの入力端に印加される。そして1本発明においては5
通過検出手段の受光器20bによる通過検出信号がロボ
ット制御装置22に入力式れると、該ロボット制御装置
22はその時点からロボットハンド14を有した多関節
腕工2を含めたロボット動作部に駆動命令を送出して作
動させ、ロボットハンド14′f:定位[18bにおい
て対象物18に到達させ、これに他のワークの嵌設作業
等のロボット作業を遂行させるものである。つまり、ラ
イントラッキング動作音させるものである。このとき、
ロボット動作部の矢印l A 1方向における走行モー
ド全縦軸に速3 v 、横軸に時間tをとって図示した
ものが第2図である。
すなわち、第2図において、線(1)は対象物18がコ
ンベア16と共に一定速度■oで走行する定速走行モー
ド金示し、線(II)はロボット動作部の走行モードを
示している。横ill tにおいて1時刻【0は通過検
出手段の受光器20bが対象物18の通過を検出したと
きを示し、遅れ時間ムt(iの時刻11からロボット動
作部は矢印へ方向に時刻t2’2で加速走行される。こ
の間にロボッ)U作部は静止状態から速度Vlに達して
おり、特にこの速1fV+はコンベア16及び対象物1
8の走行速度■oよυ高レベルの速度であることを特徴
とし1次いでロボット動作部はこの走行速度V、で適宜
時間に亘って定速走行し、更にその後には速度Vlから
速度voまで減速走行し1時刻t3においてコンベア1
6上の対象物18に位R18bで邂逅しているのである
。この時刻t3後にはコンベア16と同期して速[VO
で走行し、この間に所望のロボット作業がロボット動作
部から対象物18に遂行される。
さて、こ\でロボット10のロボット動作部に所望のロ
ボット作業全遂行させるためには、予めロボット制御装
@22に対してプログラミングにより動作の教示(ティ
ーチング)が行われる。このプログラミングはロボット
10の関節座標系において、定置されたロボット10に
より静止状態の対象物に対して所望のロボット作業を遂
行させるようにティーチングが行われることは従来より
周知でりり、葦た。斯る関節座標系におけるプログラミ
ング内容を座標変換マトリクスによって直交座標系に変
換し、直交座標系において所望のロボット作業を遂行さ
せ得ることも周知である。即ち0次式はロボット制御装
置22における座標変換機能を示したものである。
X i = J II l ・・・・・・・・・・・・
・・・(1)(1)において、 I′L、i :関節座
禅系におけるプログラミング内容、J:変換マトリクス
+ X+ ’ x + y +2直交座標系におけるプ
ログラミング内容。
従って(1)式を用いれば* x+ Y+ 7!直交座
簿系におけるロボット動作部の動作に関する教示をロボ
ット制御装置i: 22に付与することができる。即ち
1例えばX+ Y+ Z直交座標系においてロボット動
作部を一定の原点位置から動作させて該直交座標系にお
ける予め定めた位置に於きワークを掴持し、そのワーク
を他の予め定めた位置に搬送し。
そこで他のワーク上に嵌設係合させる等の動作を遂行は
せることができるのである。然るに1本発明においては
、@2図に示したロボット動作部の走行モードのクジフ
図かし明らかなように、ロボット動作部はx+Y+”座
標系における平面内の一方向1例えばy方向に速度vo
で走行する対象′物18に対し、その対象物18の一定
位置における通過検出時点から第2図に線(II)で示
した走行モードにより追走し、所定の位lit 18b
で該対象物18に邂逅した時点から該対象物18と併走
しながら所望のロボット作業を遂行するように制御され
なければなしない。故に本発明においては。
ロボット100ロボツト動作部をコンベア16上の対象
物18に向けて追走させ、該対象物18に到達邂逅させ
る過程では、予め、ロボy)制御装置K? 22 VC
追走ルーチン金ブロク“ラミングして保持させ、速度検
出器24による速度検出信号から対象物18が足位置1
8bに達する捷では、該追走ルーチンによってロボット
動作部を動作制御するのである。そして、ロボット動作
部が対象物18に到達した時点から上述の如く、予め教
示した作業遂行プログラミングにより対象物18へ所定
のロボット作業を施すのである。
第3図は上述したロボット制i′i+1装置22が何う
制]1機能をブロック図で示したものである。
第3図において、ロボット制御装置22は変換機能部2
6.追走ルーチン伎能部28.積分器30、逆変換機能
部32.アンドゲート34〜40.排他論理和回路42
等を有し1通過検出手段の受光器20b(第1図)から
発せられる対象物18の通過検出信号によって発生する
信号s1と追走完了によって発生する信号S2とに従っ
て・ 追走ルーチン機能部28又は変換機能都26から
追走走行モードにおけるプログラミング又はロボット作
業モードにおけるロボット作業プログラミングを発生し
、これらを逆変換機能部32において再び関節座標系に
おけるプログラミング内容に逆変換してからロボット1
0の動作部を作動させているものである。なお、ロボッ
ト作業モードにおいては、ロボット動作部がコンベア1
6および対象物18と一定方向に併走しながらロボット
作業を遂行するので、速度検出器24から検出器れた速
度信号に基く位置データXcがアンドゲート40を介し
て加算点におき窪換機能部26からの直角座標系におけ
るロボット作業プログラミングX1に加算される構成が
採られている。
第4(9)は王道したロボット制御装置22における機
能の発生タイミングを示したタイムチャートであり、S
’+Sn+tはライントラッキングの開始と終了の指令
信号である。通過検出信号が通過検出器(第1図の20
a、20h)から入力すると。
信号S1が発生し、ロボット動作部が対象物18に追走
してこれに到達邂逅した時点で信号S2が発生するよう
に形成され1両値号S1.S2はライントラッキング終
了指令によって消滅する。なお、第4図において、ロボ
ット作業機能のタイムチャートは追走ルーチン機能の終
了によってロボット動作部がコンベア16上の対象物1
8に到達邂逅した以後のロボット作業における直角座標
系における動作を模式的に示したものである。
以上の説明から明らかなように1本発明によれば、コン
ベアにより運搬される対象物に対してロボットの動作部
が追走し、その対象物に到達する過程では、ロボット動
作部がコンベア走行速度より高速域の速匿マで加速され
てから対象物に定位置で追いつくように制御されるライ
ントラッキング制御方法が採られるので、ロボット動作
部の駆、 動量始時における移動遅れ、加速中の移動遅
れを完全に回復して定位置に於き対象物に追いつくこと
が可能となる。依ってロボットのライントラッキング制
御における精度向上が保証されるのでおる。
【図面の簡単な説明】
第1図は本発明によるロボットのライントラッキング制
御方法を実施するシステム構成を示す機構図、第2図は
同制御方法におけるロボット動作部の走行パターンを示
すグラフ図、第3図はロボット制御装置における作用機
能を説明するブロック図、第4図は同制御装置における
機能のタイムチャートを示す図。 10・・・ロボット、 12・・・多関節腕。 14・・・ロボットアーム、16・・・コンベア。 18・・・対象物、 20a・・・発光器。 20b・・・受光器、 22・・・ロボット制御装置。 24・・・速度検出器。 第1図 第2図 LOtI L2 13 を 第3図 6

Claims (1)

  1. 【特許請求の範囲】 1、定方向に略定速度でライン走行するコンベア手段上
    の対象物をロボット動作部によって追走し、該対象物に
    所定のロボット作業を遂行させるロボットのライントラ
    ッキング制御方法において。 前記コンベア手段の走行速度と前記コンベア手段のライ
    ン走行路の一定位置における前記対象物の通過とを検出
    し、′通過したときに前記ロボット動作部を駆動して前
    記コンベア手段の走行速度より高速度まで加速移動させ
    1次いでその高速度で定速ライン走行させることによっ
    て所定の位置で前記対象物に到達邂逅させるようにした
    こと全特徴とするロボットのライントラッキング制御方
    法。 2、特許請求の範囲第1項に記載のロボットの2イント
    ジツキング制御方法において、n11記コンベア手段の
    走行速度の検出信号と前記対象物の通過検出信号とをロ
    ボット動作部の作動制御装置に入力させるようにしたロ
    ボットのライントラッキング制御方法。 3、特許請求の範囲第1項に記載のロボットのライント
    ラッキング制御方法において、前記ロボット動作部は前
    記コンベア手段上の前記対象物に到達したとき、該コン
    ベア手段の走行方向に同期ライン走行するように減速制
    御きれるロボットのライントラッキング制御方法。
JP59000745A 1984-01-09 1984-01-09 ロボツトのライントラツキング制御方法 Pending JPS60144806A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP59000745A JPS60144806A (ja) 1984-01-09 1984-01-09 ロボツトのライントラツキング制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP59000745A JPS60144806A (ja) 1984-01-09 1984-01-09 ロボツトのライントラツキング制御方法

Publications (1)

Publication Number Publication Date
JPS60144806A true JPS60144806A (ja) 1985-07-31

Family

ID=11482235

Family Applications (1)

Application Number Title Priority Date Filing Date
JP59000745A Pending JPS60144806A (ja) 1984-01-09 1984-01-09 ロボツトのライントラツキング制御方法

Country Status (1)

Country Link
JP (1) JPS60144806A (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0485247U (ja) * 1990-11-30 1992-07-24
US5254923A (en) * 1991-07-24 1993-10-19 Nachi-Fujikoshi Corp. Industrial robot synchronous control method and apparatus
US5512528A (en) * 1991-08-19 1996-04-30 Jgc Corporation Catalysts used for producing carbonic acid esters and methods of producing carbonic acid esters using the same
WO1999014645A1 (de) * 1997-09-18 1999-03-25 Homag Maschinenbau Ag Verfahren und vorrichtung zur durchlaufbearbeitung von plattenförmigen werkstücken
JP2009183236A (ja) * 2008-02-07 2009-08-20 Yanmar Co Ltd 管理機

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0485247U (ja) * 1990-11-30 1992-07-24
US5254923A (en) * 1991-07-24 1993-10-19 Nachi-Fujikoshi Corp. Industrial robot synchronous control method and apparatus
US5512528A (en) * 1991-08-19 1996-04-30 Jgc Corporation Catalysts used for producing carbonic acid esters and methods of producing carbonic acid esters using the same
US5650369A (en) * 1991-08-19 1997-07-22 Jgc Corporation Catalysts used for producing carbonic acid esters and methods of producing carbonic acid esters using the same
WO1999014645A1 (de) * 1997-09-18 1999-03-25 Homag Maschinenbau Ag Verfahren und vorrichtung zur durchlaufbearbeitung von plattenförmigen werkstücken
JP2009183236A (ja) * 2008-02-07 2009-08-20 Yanmar Co Ltd 管理機

Similar Documents

Publication Publication Date Title
US4669168A (en) Method and system for automatically attaching works onto vehicle bodies carried on a conveyor
CN111026164B (zh) 一种机器人目标跟踪轨迹规划方法
US5477117A (en) Motion controller and synchronous control process therefor
US3958682A (en) Coordination of robot and conveyor
KR850007038A (ko) 가동장치 구동시스템
JP2524931B2 (ja) ロボットの直線補間方法
GB1525839A (en) Apparatus for controlling movements of a machine element relative to a workpiece
JPS61157909A (ja) ロボツトの経路誤差補正方式
US4562551A (en) Robot control system
KR950026805A (ko) 크레인의 진동방지를 위한 속도 제어방법
JPS60144806A (ja) ロボツトのライントラツキング制御方法
JP2000025664A (ja) ワーク追従装置
JP2735126B2 (ja) ロボットの制御方法及びその制御装置
JPS61257814A (ja) コンベアの同期制御装置
JPH05245556A (ja) 搬送制御装置
KR0161004B1 (ko) 다관절 로보트의 연속이동 제어방법
RU2027583C1 (ru) Система управления манипуляционным роботом
JPH0737824Y2 (ja) ロボツトのコンベア同期装置
JPS6232508A (ja) 数値制御装置のサ−ボ系の位置決め制御方法
KR100218379B1 (ko) 로보트팔 제어방법
JPH0315908A (ja) 移動部材の軌跡方向の加減速方法
JPS62277289A (ja) 追従制御装置
JP2648223B2 (ja) 砲サーボの障害物回避方法
JPS62203207A (ja) 追従制御装置
JP2728260B2 (ja) サーボ制御装置