[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JPH05138563A - ロボツトの制御装置 - Google Patents

ロボツトの制御装置

Info

Publication number
JPH05138563A
JPH05138563A JP32401591A JP32401591A JPH05138563A JP H05138563 A JPH05138563 A JP H05138563A JP 32401591 A JP32401591 A JP 32401591A JP 32401591 A JP32401591 A JP 32401591A JP H05138563 A JPH05138563 A JP H05138563A
Authority
JP
Japan
Prior art keywords
acceleration
deceleration
temporary
command value
robot
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
JP32401591A
Other languages
English (en)
Other versions
JP2674398B2 (ja
Inventor
Masanobu Ito
雅信 伊藤
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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric 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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP3324015A priority Critical patent/JP2674398B2/ja
Publication of JPH05138563A publication Critical patent/JPH05138563A/ja
Application granted granted Critical
Publication of JP2674398B2 publication Critical patent/JP2674398B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

(57)【要約】 【目的】 ロボットの移動動作に関する能力を最大限に
発揮し、タクトタイムを短縮する。 【構成】 負荷情報バッファ(12)に各軸の位置及び姿勢
に対する負荷情報を記憶させる。仮加減速度算出手段(1
3)で、負荷情報と現在位置と目標位置から、負荷に依存
した仮加速度及び仮減速度を算出し、これらを用いて制
御したときの仮加速完了位置及び仮減速開始位置を算出
した後、これらの仮位置の負荷条件から移動動作の加速
度指令値及び減速度指令値を決定する。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】この発明はロボットを加速度指令
値及び減速度指令値により制御する装置に関するもので
ある。
【0002】
【従来の技術】図6及び図7は従来のロボットの制御装
置を示す図で、図6は全体構成図、図7は速度指令値及
び加速度指令値を示す図である。
【0003】図6において、(1)はロボットの使用者が
ロボットに所望の作業をさせるための手順が記述されて
いる複数のプログラムと、複数の移動目標位置のデータ
が格納されているプログラムメモリで、プログラム中、
移動命令の実行が開始されるごとに閉成されるスイッチ
(2)を介して移動目標位置が格納されるバッファ(3)に接
続されている。
【0004】(4)はロボットの現在位置が格納されるバ
ッファ、(5A)(5B)はそれぞれ加速度指令値及び減速度指
令値が格納されているバッファ、(6)はロボットに許容
される動作最高速度が格納されているバッファ、(7)は
各バッファ(3)(4)(5A)(5B)(6)に格納された目標位置、
現在位置、加速度指令値、減速度指令値及び許容最高速
度に基づいて、移動動作中の各時点における速度指令値
を決定する速度指令手段、(8)は速度指令値が書き込ま
れるバッファである。
【0005】従来のロボットの制御装置は上記のように
構成され、ロボットのプログラムの実行が開始される
と、移動命令の実行ごとにスイッチ(2)が閉成され、プ
ログラムメモリ(1)から移動目標位置がバッファ(3)に格
納される。目標位置がバッファ(3)に格納されると、ス
イッチ(2)は開放する。
【0006】バッファ(5A)(5B)には、それぞれあらかじ
め定められた加速度指令値及び減速度指令値が設定され
ており、これらはロボットの位置及び負荷状態に関係な
く、各移動動作で一定である。速度指令手段(7)は、こ
の加速度指令値、減速度指令値、前時点の速度、目標位
置及び現在位置に基づいて、許容最高速度を越えないよ
うに速度指令値を算出し、これをバッファ(8)に書き込
むと同時に、バッファ(4)の現在位置を更新する。
【0007】この際、図7に示すように速度指令値Vp
の最高速度Vmに達するまでの加速時間T1には、バッフ
ァ(5A)の加速度指令値αpの加速度αkが用いられ、最高
速度Vmから目標位置に達するまでの減速時間T2には、
バッファ(5B)の減速度指令値βpの減速度−βlが用いら
れ、目標位置までの速度が制御される。
【0008】なお、上述のように、移動動作において使
用される加速度αkと減速度−βlは、一定値が指定され
ていて、各動作で同一であり、各軸同時に移動動作が完
了するように速度制御される。ロボットの移動動作の場
合、動作姿勢又はハンドリング対象のワーク形状、重量
等により、ロボットに加わる負荷状態が種々多様であ
る。このため、上記加速度αk及び減速度−βlは、ロボ
ットにとって最も負荷の加わる状態でも支障なく動作で
きるように決定されている。また、ロボットに余裕があ
る場合でも、このようにして決定された加速度αk及び
減速度−βlを採用して移動動作するようにしている。
【0009】
【発明が解決しようとする課題】上記のような従来のロ
ボットの制御装置では、移動動作時の加速度αk及び減
速度−βlが、最大負荷を対象として決定されているた
め、ロボットの持つ最大能力を移動動作時に発揮でき
ず、また、ロボットが目標とする時間内で作業を完了す
ることができないという問題点がある。
【0010】この発明は上記問題点を解消するためにな
されたもので、負荷状態に応じて移動動作におけるロボ
ットの能力を最大限に発揮させ、かつ目標とする時間内
で作業を完了することができるようにしたロボットの制
御装置を提供することを目的とする。
【0011】
【課題を解決するための手段】この発明の第1の発明に
係るロボットの制御装置は、ロボットの各軸の位置及び
姿勢に対する負荷情報を記憶し、この負荷情報から仮加
速度及び仮減速度を算出し、この仮加速度及び減速度を
用いて制御したときの仮加速完了位置及び仮減速開始位
置を算出し、これらの位置と負荷情報から加速度指令値
及び減速度指令値を決定するようにしたものである。
【0012】また、第2の発明に係るロボットの制御装
置は、第1の発明のものにおいて、仮加速完了位置から
加速度候補を、仮減速開始位置から減速指令値を決定
し、加速度候補及び仮加速度に基づいて加速度指令値を
変化させるようにしたものである。
【0013】
【作用】この発明の第1の発明においては、負荷情報か
ら仮加減速度を算出し、この仮加減速度で制御したとき
の仮加速完了位置及び仮減速開始位置と負荷情報から加
減速度指令値を決定するようにしたため、負荷状態に適
合する加減速度が決定する。
【0014】また、第2の発明においては、加速度候補
及び仮加速度に基づいて加速度指令値を変化させるよう
にしたため、一つの移動の間で加速度を変化できる。
【0015】
【実施例】
実施例1.図1〜図3はこの発明の第1の発明の一実施
例を示す図で、図1は全体構成図、図2は負荷情報バッ
ファの内容図、図3は仮加減速度算出動作フローチャー
トであり、従来装置と同様の部分は同一符号で示す。
【0016】図1において、(11A)(11B)はそれぞれロボ
ットに許容される最大加速度及び最大減速度が格納され
たバッファであり、この最大加速度及び最大減速度はあ
らかじめ定められた一定値である。(12)は図2に示すよ
うにロボットの各軸座標に対する加速度係数及び減速度
係数が格納されたバッファで、これらの係数はロボット
の位置及び姿勢に対する負荷状態を表している。
【0017】(13)はバッファ(3)(4)(11A)(11B)(12)に接
続され、仮加速度及び仮減速度を算出する仮加減速度算
出手段、(14A)(14B)はそれぞれ上記仮加速度及び仮減速
度を格納するバッファ、(15)はバッファ(3)(4)(14A)(14
B)に接続され仮加速度及び仮減速度を使用して速度制御
した場合の仮加速完了位置及び仮減速開始位置を算出す
る加減速仮位置算出手段、(16A)(16B)はそれぞれ上記仮
加速完了位置及び仮減速開始位置を格納するバッファで
ある。
【0018】(17)はバッファ(11A)(11B)(12)(16A)(16B)
に接続され各移動動作における加速度及び減速度を決定
する加減速度決定手段、(18A)(18B)は加減速度決定手段
(17)に接続され移動動作の開始時閉成し、加減速度決定
手段(17)が加速度指令値及び減速度指令値をそれぞれバ
ッファ(5A)(5B)に書き込むと開放するスイッチである。
【0019】次に、この実施例の動作を図3を参照して
説明する。なお、目標位置の格納、現在位置の更新及び
加減速度が決定された後の速度制御については、従来装
置と同様であるので、詳細な説明は省略する。
【0020】一般に、各移動動作における負荷状態は、
図7のような速度指令値Vpを用いた場合、加速完了付
近と減速開始付近、すなわち加減速指令が変化する付近
に依存することが多い。これに着目して、この実施例で
は以下のようにして、各動作の加速度及び減速度を決定
している。
【0021】仮加減速度算出手段(13)では、ステップ(2
1)でバッファ(4)の現在位置とバッファ(3)の目標位置か
ら移動に関与する軸を求める。ステップ(22)ではステッ
プ(21)で求めた軸について、図2に示すバッファ(12)の
負荷情報を検索し、現在位置から加速度係数ak1,・・・,
akjを抽出する。そして、ステップ(23)で次式により、
仮加速度αkを求め、バッファ(14A)に書き込む。 αk=min{ak1αk1,・・・,akjαkj}・・・(1) ここに、αk1,・・・,αkj:対応する軸の許容最大加速度
【0022】ステップ(24)では、ステップ(21)で求めた
軸について、同様にバッファ(12)の負荷情報を検索し、
バッファ(3)の目標位置から減速度係数bl1,・・・bljを
抽出する。そして、ステップ(25)で次式により仮加速度
減速度−βlを求め、バッファ(14B)に書き込む。 −βl=min{bl1βl1,・・・,bljβlj}・・・(2) ここにβl1,・・・,βlj:対応する軸の許容最大減速度
【0023】次に、加減速度仮位置算出手段(15)は、バ
ッファ(14A)の仮加速度αkと、バッファ(14B)の減速度
−βlを用いて、現在位置から目標位置まで移動させた
場合の仮加速完了位置と仮減速開始位置を算出し、その
数値をそれぞれバッファ(16A)(16B)に書き込む。
【0024】加減速度決定手段(17)は、仮加減速度算出
手段(13)が現在位置及び目標位置から仮加速度及び仮減
速度を算出したのと同じ手順で、本動作における加速度
及び減速度を算出して、その数値をそれぞれバッファ(5
A)(5B)に書き込む。
【0025】このとき、加減速度決定手段(17)は、現在
位置の代わりに、バッファ(16A)の仮加速完了位置を、
目標位置の代わりに、バッファ(16B)の仮減速開始位置
を使用して加速度及び減速度を決定する。速度指令手段
(7)は、上記決定された加速度、減速度、許容最大速
度、現在位置及び目標位置を用いて速度指令値を決定す
る。このようにして、移動動作において最も負荷のかか
る加速完了位置と減速開始位置の負荷状態に合わせて、
各移動動作の加速度及び減速度を決定している。
【0026】実施例2.図4及び図5はこの発明の第2
の発明の一実施例を示す図で、図4は全体構成図、図5
は速度指令値及び加速度指令値を示す図であり、実施例
1と同様の部分は同一符号で示す。
【0027】実施例1では、各移動ごとに加速度及び減
速度を可変に設定することは可能であるが、加速度及び
減速度が決定された後には、一つの移動動作の間でその
数値は一定である。実施例2では一つの移動動作の間で
加速度を可変に決定するものである。
【0028】図4において、(31)はスイッチ(18A)に接
続され加速度候補が書き込まれるバッファ、(32)はバッ
ファ(14A)(31)に接続された加速度候補と仮加速度に基
づいて各時点ごとに加速度指令値を算出する加速度指令
手段である。
【0029】この実施例の特徴は加速度指令値を決定す
ることにあり、減速度指令値の決定手順は実施例1と同
様であり、目標位置の格納、現在位置の更新及び加減速
度が決定された後の速度制御については、従来装置と同
様である。
【0030】加減速度決定手段(17)は、実施例1と同様
の手順で、バッファ(16A)の仮加速完了位置及びバッフ
ァ(16B)の仮減速開始位置から加速度候補及び減速度を
決定し、それぞれバッファ(31)及びバッファ(5B)にその
数値を書き込む。
【0031】バッファ(14A)の仮加速度をα0、バッファ
(31)の加速度候補をα1とする。次に、次に、加速度指
令手段(32)は、図5に示すように移動開始位置では、仮
加速度α0が、加速完了位置では加速度候補α1が加速度
指令値αpとなるように、連続的に加速度指令値αpを算
出し、各時点ごとにその数値をバッファ(5A)に書き込
む。このようにして、一つの移動動作の間に、移動開始
位置と加速完了位置の間で加速度を変化させ、移動開始
位置の余裕に合わせて、加速度指令値αpを決定してい
る。
【0032】
【発明の効果】以上説明したとおり、この発明の第1の
発明では、負荷情報から仮加減速度を算出し、この仮加
減速度で制御したときの仮加速完了位置及び仮減速開始
位置と負荷情報から加減速度指令値を決定するようにし
たので、負荷状態に適合する加減速度が決定され、ロボ
ットを無理なく動作させることができると共に、ロボッ
トのタクトタイムを短縮できる効果がある。
【0033】また、第2の発明では、加速度候補及び仮
加速度に基づいて加速度指令値を変化させるようにした
ので、一つの移動の間で加速度を変化させることがで
き、ロボットの能力を最大限に発揮できる効果がある。
【図面の簡単な説明】
【図1】この発明の実施例1を示す全体構成図。
【図2】図1の負荷情報バッファの内容図。
【図3】仮加減速度算出動作フローチャート。
【図4】この発明の実施例2を示す全体構成図。
【図5】図2の速度指令値及び加速度指令値を示す図。
【図6】従来のロボットの制御装置を示す全体構成図。
【図7】図6の速度指令値及び加速度指令値を示す図。
【符号の説明】
3 目標位置バッファ 4 現在位置バッファ 5A 加速度指令値バッファ 5B 減速度指令値バッファ 7 速度指令手段 8 速度指令値バッファ 12 負荷情報記憶装置(負荷情報バッファ) 13 仮加減速度算出手段 14A 仮加速度バッファ 14B 仮減速度バッファ 15 加減速仮位置算出手段 16A 仮加速完了位置バッファ 16B 仮減速開始位置バッファ 17 加減速度決定手段
─────────────────────────────────────────────────────
【手続補正書】
【提出日】平成4年7月30日
【手続補正1】
【補正対象書類名】明細書
【補正対象項目名】0022
【補正方法】変更
【補正内容】
【0022】ステップ(24)では、ステップ(21)で求めた
軸について、同様にバッファ(12)の負荷情報を検索し、
バッファ(3)の目標位置から減速度係数bl1,・・・blj
抽出する。そして、ステップ(25)で次式により仮加速度
減速度−βlを求め、バッファ(14B)に書き込む。βl =min{bl1βl1,・・・,bljβlj}・・・(2) ここにβl1,・・・,βlj:対応する軸の許容最大減速度

Claims (2)

    【特許請求の範囲】
  1. 【請求項1】 加速度指令値及び減速度指令値によりロ
    ボットの各軸を移動させ、上記各軸の移動動作の際上記
    各軸が同時に移動を完了するように速度制御される装置
    において、上記各軸の位置及び姿勢に対する負荷情報を
    記憶する負荷情報記憶装置と、上記負荷情報から仮加速
    度及び仮減速度を算出する仮加減速度算出手段と、上記
    仮加速度及び仮減速度を用いて制御したときの仮加速完
    了位置及び仮減速開始位置を算出する加減速仮位置算出
    手段と、上記仮加速完了位置及び仮減速開始位置と上記
    負荷情報から上記加速度指令値及び減速度指令値を決定
    する加減速度決定手段とを備えたことを特徴とするロボ
    ットの制御装置。
  2. 【請求項2】 加速度指令値及び減速度指令値によりロ
    ボットの各軸を移動させ、上記各軸の移動動作の際上記
    各軸が同時に移動を完了するように速度制御される装置
    において、上記各軸の位置及び姿勢に対する負荷情報を
    記憶する負荷情報記憶装置と、上記負荷情報から仮加速
    度及び仮減速度を算出する仮加減速度算出手段と、上記
    仮加速度及び仮減速度を用いて制御したときの仮加速完
    了位置及び仮減速開始位置を算出する加減速仮位置算出
    手段と、上記仮加速完了位置及び仮減速開始位置から加
    速度候補及び上記減速度指令値を決定する加減速度決定
    手段と、上記加速度候補及び上記仮加速度に基づいて上
    記加速度指令値を変化させる加速度指令手段とを備えた
    ことを特徴とするロボットの制御装置。
JP3324015A 1991-11-13 1991-11-13 ロボットの制御装置 Expired - Lifetime JP2674398B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP3324015A JP2674398B2 (ja) 1991-11-13 1991-11-13 ロボットの制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP3324015A JP2674398B2 (ja) 1991-11-13 1991-11-13 ロボットの制御装置

Publications (2)

Publication Number Publication Date
JPH05138563A true JPH05138563A (ja) 1993-06-01
JP2674398B2 JP2674398B2 (ja) 1997-11-12

Family

ID=18161189

Family Applications (1)

Application Number Title Priority Date Filing Date
JP3324015A Expired - Lifetime JP2674398B2 (ja) 1991-11-13 1991-11-13 ロボットの制御装置

Country Status (1)

Country Link
JP (1) JP2674398B2 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6127792A (en) * 1998-03-30 2000-10-03 Denso Corporation Control apparatus for robot
JP2008132595A (ja) * 2008-02-08 2008-06-12 Mitsubishi Electric Corp ロボット制御装置

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62245303A (ja) * 1986-04-17 1987-10-26 Matsushita Electric Ind Co Ltd ロボツトの位置制御方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62245303A (ja) * 1986-04-17 1987-10-26 Matsushita Electric Ind Co Ltd ロボツトの位置制御方法

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6127792A (en) * 1998-03-30 2000-10-03 Denso Corporation Control apparatus for robot
DE19914245B4 (de) * 1998-03-30 2009-05-07 Denso Corp., Kariya-shi Roboter-Steuervorrichtung
JP2008132595A (ja) * 2008-02-08 2008-06-12 Mitsubishi Electric Corp ロボット制御装置

Also Published As

Publication number Publication date
JP2674398B2 (ja) 1997-11-12

Similar Documents

Publication Publication Date Title
JPH0388019A (ja) データ処理装置
JPH05138563A (ja) ロボツトの制御装置
JPH0457005B2 (ja)
JP2015134395A (ja) ロボット、ロボットの制御方法、及びロボットの制御プログラム
US4816992A (en) Method of operating a data processing system in response to an interrupt
JP2705367B2 (ja) ロボットの制御装置
JPH0916229A (ja) 産業用ロボット
JPS6190207A (ja) ロボツト制御装置
JPH03242703A (ja) モータ制御でのフィードフォアードゲインの学習方法
JPH0477915A (ja) 磁気ディスク制御装置
JP2521338B2 (ja) パレタイジング/デパレタイジング制御方法
JPS63239511A (ja) ロボツト・システム
JPS62192807A (ja) ロボツト制御方式
JPS59226947A (ja) メモリのデ−タアクセス方式
JPS62166431A (ja) ロボツト言語の単語検索方式
JPH06100931B2 (ja) 産業用ロボットの制御情報作成装置における変更プログラム作成方法
JPS6051955A (ja) 数値制御装置
JPS59180877A (ja) メモリの読出し制御方式
JPH0290303A (ja) 時定数可変機能付ロボット制御装置
JPH0550358A (ja) 数値制御プログラムへのワーク搬入要求付加方法
JPH0410292A (ja) ハードディスク装置
JPH0228857A (ja) 電子計算機
JPS6046747B2 (ja) 初期プログラム読込方式
JPH05189505A (ja) 図面編集方法および装置
JPS58208851A (ja) マイクロプログラム制御装置