JPS60198604A - 多関節マニピユレ−タの制御方法 - Google Patents

多関節マニピユレ−タの制御方法

Info

Publication number
JPS60198604A
JPS60198604A JP5353584A JP5353584A JPS60198604A JP S60198604 A JPS60198604 A JP S60198604A JP 5353584 A JP5353584 A JP 5353584A JP 5353584 A JP5353584 A JP 5353584A JP S60198604 A JPS60198604 A JP S60198604A
Authority
JP
Japan
Prior art keywords
manipulator
control
memory
route
reset
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.)
Granted
Application number
JP5353584A
Other languages
English (en)
Other versions
JPH0797288B2 (ja
Inventor
Ikuko Matsushita
松下 郁子
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.)
Toshiba Corp
Original Assignee
Toshiba 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 Toshiba Corp filed Critical Toshiba Corp
Priority to JP59053535A priority Critical patent/JPH0797288B2/ja
Publication of JPS60198604A publication Critical patent/JPS60198604A/ja
Publication of JPH0797288B2 publication Critical patent/JPH0797288B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime 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/18Numerical 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/406Numerical 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 monitoring or safety
    • G05B19/4067Restoring data or position after power failure or other interruption
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/45Nc applications
    • G05B2219/45083Manipulators, robot
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/50Machine tool, machine tool null till machine tool work handling
    • G05B2219/50103Restart, reverse, return along machined path, stop

Abstract

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

Description

【発明の詳細な説明】 〔発明の技術分野〕 本発明は、産業用ロボット、特(二複雑かつ狭隘な空間
で移動する多関節マニピュレータの制御方法に関する。
〔発明の技術的背景とその問題点〕
現在、産業用ロボット、例えば遠隔操作で制御される多
関節マニピュレータは色々な分野で開発されているが、
この多関節マニピュレータ(=はその目的(=応じて例
えば複雑で狭隘な空間を移動して点検作業を行な′ンこ
とを要求されるものがある。
ところで、多関節マニピュレータの運動制御方法は大体
2つに分けることができる。1つは手動による制御、他
の1つは自動による一制御である。
前者の手動)二よる制御はオペレータが遠隔操縦するも
ので、スイッチ、ジョイスティックなど(二より動かす
もの、またはマスタースレーブ方式(二よるものなどが
ある。後者の自動)二よる制御は、予じめ決められた手
順(二従って操作されるもので、手順の教示方式によp
シーケンス方式、プ1/イバツク方式、プログラム方式
などがある。また、最近では知能を持つものとして、感
覚及び認識機能を持ちそれ(二よって行動を決定するも
のが試みられている。
ところが、一般(二複雑かつ狭隘な空間内で多関節マニ
ピュレータを手動させる場合、手動(二よる遠隔操縦で
は、周囲の構造物C二接触した多元の位置(=戻すのが
むずかしくなったシする。そこで、自動であらかじめ決
められた手順に従って制御する自動制御方法が採られる
ことが多いが、自動制御だけでは操作のための自由度が
ないので手動による制御も可能な多関節マニピュレータ
の制御方法が望まれていた。
これらの要望を満たす多関節マニピュレータの制御方法
としては、自動で予じめ決められた手順に に従9て制御し即に決められた手順とは違う動作をさせ
たい時、その時点で手動(二切p換えてオペレータ(二
よる遠隔操縦によってマニピュレータを動作させ、目的
の移動作業が終了した後再び自動制御(=戻υ、次の移
動を行なうという制御方法が考えられる。しかしながら
、このように手動へ二よる試行錯誤によって複雑で狭隘
な空間でマニピュレータを動作させた後、再び自動制御
するため元の位置すなわち手動制御の初期状態(=戻す
のは動かした関節の数、周囲の状況(:もよるが必ずし
も容易ではなかった。
〔発明の目的〕
本発明は、上記事情に鑑みてなされたもので、その目的
は、複雑かつ狭隘な空間を移動する多関節マニピュレー
タを手動で操縦した場合、手動制御の始めの位置に容易
に戻すための多関節マニピュレータの制御方法を提供す
る屯二ある。
〔発明の概要〕
本発明は上記目的を達成するため(二、少くとも手動(
二よる制御可能な1′)以上の関節をもつ多関節マニピ
ュレータの制御方法4=おいて前記マニピュレータの手
動制御の初期位置から最終位置までの経路を順次メモリ
に格納するととも(−このメモリに格納されたデータを
逆(=追従することによって前記マニピュレータの初期
位置(二次るように構成したものである。そして、手動
制御の初期位置(二次る経路のうちループを形成する経
路はその交差地点のみを通過するよう(=構成されてい
る。
〔発明の実施例〕
本発明の一実施例を図面を参照して説明する。
第1図は、本発明の多関節マニピュレータの操作経路図
を示したものである。同図(二おいてマニピュレータの
先端の経路は1で示されてお9、この経路1はマニピュ
レータが周囲の構造物2(=接触せずに移動していくよ
う(二予じめ6腕の動作手順が決められている。りまシ
、6腕の座標の変化がテーブルとして用意されている。
そしてマニピュレータを自動制御から手動制御に切シ変
えた位置で6腕の座標を初期位置(Xal+7町バたソ
しlは軸番号)とする。この位置からオペレータが手動
で遠隔操縦すると、当然のことなから6腕の座標は変わ
っていくが、これは予じめ教え込まれているテーブルの
値からはずれていくので、目的動作終了後再び自動制御
しようとする場合は教え込まれているテーブル上の値で
ある元の位置、ここでは手動制御を始めた初期位tL 
(XaI、7.1)1=戻らなければ次の自m1tll
J御を続けることができない。
しかしながら、マニピュレータを手−で遠14操縦する
ことは、オペレータが目的(二回って複雑で狭隘な空間
を自在(:経路3のよう(二試行錯誤的)二腕を動かし
ていくので、再びオペレータが手動遠隔操縦で元の位置
(二次すことは大変な時間を要すること1二なる。
そこで本発明では、手動遠隔操縦で経路3のよう(二腕
を動かしていく場合、それらの座標の変化(xll’ 
l yti’) l (x*+’ e )’tt’) 
* ・・・ を自ら記憶し、との記憶(=基づいてテー
ブルを作り、目的動作が終了した後、元の位置(二次る
時(二自らの記憶を逆にたどること::よって経路3を
逆C二通シ、無理なく元の位置に戻るという制御システ
ムを採用している。このことを第2図のフローチャート
でさら(二詳しく説明すると、自動制御から手動制御え
の切換え指令が出されると、第1ステツプで手動切り換
えがなされ、次の第2ステツプでは手動遠隔操縦が行な
われる。第3ステツプでは6腕の座標がメモリに格納さ
れるととも(ニメモリではテーブルが作成される。次の
第4ステツプでは目的が達成されたか否かの判定が行な
われ、目的が達成されていなければ第2ステツプからの
動作が繰シ返えされる。そして、目的が達成されれば、
次の第5ステツプ(=おいてメモリに格納されているメ
モリテーブルを逆からたどって6腕の動作を制御し、第
6ステツプでは元の位置に戻ったかどうかの判定がなさ
れる。もし元の位置でないならば第5ステツプからの動
作が繰9返えされる。そして、元の位置に達したならば
、次のステップの自動制御え切り換えられる。
第3図は、上述したような制御を行なうだめのブロック
構成図の概要を示すものでおる。中央処理装置CPU 
4は操作部5のスイッチ、ジョイスティックなどからの
遠隔操縦信号(:よ多モータ駆動回路部8ζ二制御信号
を送シ、動作制御を行ない位置信号送受信部7からの6
腕の位置をメモリ6に格納する。また、手動を解除する
ための指令を操作部から受けること(=よってメモリ6
内の記憶を基(=駆動回路部8(二−り御信号を送シ、
この信号によりマニピュレータは制御される。
したがって、本実施例によれば、複雑で狭隘な空間(二
おいて、多関節マニピュレータを手動で操縦しても自動
制御できる位置まで容易に戻すことができる。
第4図は、本発明の他の実施例の多関節マニピュレータ
の操作経路図である。同図亀二示すよう6二予じめ自動
制御のため(=決められた経路1の途中の位dL (X
sl I Fsυ1=おいて手動遠隔操縦に切シ換えら
れ、以後手動域=よ多経路9(二示すよう(二何回も試
行錯誤を繰り返し、目的位置(Xmt’ l )’ml
’) l二到達したとする。本実施例で娘、上記実施例
と同様に手動操縦の際6腕の座標の変化を自ら記憶して
いくが、目的を達成した後、手動制御(二よってメモリ
された経路9のうち閉じた経路lOが存在すると、この
ような経路10は元の位置シニ戻るため(=は無駄な経
路となるから、このような経路10は省いてその交差点
のみを含む経路11を通って自動で元の位fil (X
mt、 ym+) に戻るという制御がとられる。
したがって、本実施例によると、手動で腕を動かした場
合元の位iiiに自動でかつ無駄なく容易に戻ることが
できる。
〔発明の効果〕
以上説明したよう1二、本発明の多関節マニピュレータ
の制御方法(二よれば、複雑で狭隘な空間で多関節マニ
ピュレータを手動で遠隔操縦した後、手動制御を始めた
初期位置C:短時間で容易に戻ることができる。
【図面の簡単な説明】
第1図は本発明の一実施例の操作経路図、第2図は本発
明の一実施例の制御方法を示すフローチャート、第3図
は本発明の一実施例のブロック構成図、第4図は本発明
の他の実施例の操作経路図である。 1・・・自動制御時の経路 2・・・構造吻3、9.1
0.11・・・手動制御時の経路4・・・CPU 5・
・・操作部 6・・・メモリ 7・・・位置信号送受信器8・・・モ
ータ駆動回路図 (873:()代理人 弁理士 猪 股 祥 晃(ほか
1名)第 1 図 第 2 図 第 3 図

Claims (2)

    【特許請求の範囲】
  1. (1) 少くとも手動による制御可能な1つ以上の関節
    を持つ多関節マニピュレータの制御方法において、前記
    マニピュレータの手動制御の初期位置から最終位置まで
    の経路を順次メモリ媚二格納するととも(−前日己メモ
    リに格納されたデータを逆に追従することによって前記
    マニピュレータを手動制御の当初位置に戻るよう(二構
    成したことを特徴とする多関節マニピュレータの制御方
    法。
  2. (2) 手動制御の初期位置(二戻る経路のうちループ
    を形成する経路はその交差地点のみを通過するよう(=
    構成している特許請求の範囲第1項記載の多関節マニピ
    ュレータの制御方法。
JP59053535A 1984-03-22 1984-03-22 多関節マニピユレ−タの制御方法 Expired - Lifetime JPH0797288B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP59053535A JPH0797288B2 (ja) 1984-03-22 1984-03-22 多関節マニピユレ−タの制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP59053535A JPH0797288B2 (ja) 1984-03-22 1984-03-22 多関節マニピユレ−タの制御方法

Publications (2)

Publication Number Publication Date
JPS60198604A true JPS60198604A (ja) 1985-10-08
JPH0797288B2 JPH0797288B2 (ja) 1995-10-18

Family

ID=12945496

Family Applications (1)

Application Number Title Priority Date Filing Date
JP59053535A Expired - Lifetime JPH0797288B2 (ja) 1984-03-22 1984-03-22 多関節マニピユレ−タの制御方法

Country Status (1)

Country Link
JP (1) JPH0797288B2 (ja)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63250705A (ja) * 1987-04-08 1988-10-18 Fanuc Ltd 数値制御装置
JPH0191905U (ja) * 1987-12-10 1989-06-16
WO1997049016A1 (fr) * 1996-06-20 1997-12-24 Fanuc Ltd Dispositif servant a commander le deplacement d'un robot vers l'arriere
CN106039620A (zh) * 2016-06-14 2016-10-26 合肥市嘉升电子科技有限公司 可按任意设定路径自动灭火的消防水炮控制系统和控制方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5597606A (en) * 1979-01-19 1980-07-25 Oki Electric Ind Co Ltd Memory/reproduction system for manual operation of numerical control

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5597606A (en) * 1979-01-19 1980-07-25 Oki Electric Ind Co Ltd Memory/reproduction system for manual operation of numerical control

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63250705A (ja) * 1987-04-08 1988-10-18 Fanuc Ltd 数値制御装置
JPH0191905U (ja) * 1987-12-10 1989-06-16
WO1997049016A1 (fr) * 1996-06-20 1997-12-24 Fanuc Ltd Dispositif servant a commander le deplacement d'un robot vers l'arriere
US6285921B1 (en) 1996-06-20 2001-09-04 Fanuc, Ltd. Robot control apparatus with function for robot backward operation
CN106039620A (zh) * 2016-06-14 2016-10-26 合肥市嘉升电子科技有限公司 可按任意设定路径自动灭火的消防水炮控制系统和控制方法
CN106039620B (zh) * 2016-06-14 2018-12-07 合肥市嘉升电子科技有限公司 可按任意设定路径自动灭火的消防水炮控制方法

Also Published As

Publication number Publication date
JPH0797288B2 (ja) 1995-10-18

Similar Documents

Publication Publication Date Title
EP3342561B1 (en) Remote control robot system
US5204942A (en) Robot control system for controlling a set of industrial robots for cooperative operation
US20140142754A1 (en) System for commanding a robot
JP2514490B2 (ja) 産業用ロボットの連動手動操作による教示制御方法
EP0101955B1 (en) Path control method and apparatus
US4348623A (en) Numerical control system for controlling both a machine tool and a robot
KR950000814B1 (ko) 로보트의 동작지시 방법 및 제어장치
Penin et al. Force reflection for time-delayed teleoperation of space robots
Yokokohji et al. Operation modes for cooperating with autonomous functions in intelligent teleoperation systems
JPS5871087A (ja) ロボツトア−ムを非プログラム径路に沿って自動的に動かす装置
JP7184595B2 (ja) 工作機械システム
JPH0596477A (ja) マスタスレーブマニピユレータの制御方法
JPS60198604A (ja) 多関節マニピユレ−タの制御方法
JP2000084877A (ja) 走行軸付ロボットのオフラインティーチング方法
EP0227304A2 (en) Method of controlling a robot
CN112041128B (zh) 机器人的教导方法和机器人的教导系统
JPS62251901A (ja) 多軸ロボツトの経路制御装置
JPH0588720A (ja) ロボツトの原点位置復帰制御方法とその装置
JPS62165207A (ja) ロボツト制御装置
JPH09179612A (ja) 自動溶接装置
JPH0810520Y2 (ja) マスタ/スレ−ブ型サ−ボマニピユレ−タのインデツクス制御装置
JPS61198304A (ja) ア−ム制御方式
JPH02205495A (ja) 多関節型ロボット
KR20220074960A (ko) 경로를 따라 제어된 관절형 아암을 갖는 로봇 수술 개입 장치
JPS61262809A (ja) ロボツトの制御装置