JP2003001576A - ロボット制御装置およびその制御方法 - Google Patents
ロボット制御装置およびその制御方法Info
- Publication number
- JP2003001576A JP2003001576A JP2001190960A JP2001190960A JP2003001576A JP 2003001576 A JP2003001576 A JP 2003001576A JP 2001190960 A JP2001190960 A JP 2001190960A JP 2001190960 A JP2001190960 A JP 2001190960A JP 2003001576 A JP2003001576 A JP 2003001576A
- Authority
- JP
- Japan
- Prior art keywords
- movement
- moving
- data
- time
- 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.)
- Pending
Links
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/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40454—Max velocity, acceleration limit for workpiece and arm jerk rate as constraints
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Abstract
た場合、本来速度を下げる必要のない部分も下げること
になり、作業のタクトタイムが大きくなってしまう。 【解決手段】 移動量として移動速度と移動時間からな
る複数の移動データを記憶する手段を備え、この記憶し
た各移動データに基づいて動作を制御するロボットの制
御装置において、記憶した移動データからロボットの動
作が所定の加速度を超えるか判断し、所定の加速度を超
えると判断した場合、該当するデータとその前後の移動
データについて、移動量一定の条件下で移動時間を増加
させる手段と、これら移動時間を増加させた移動データ
を記憶する手段を備え、この再度記憶された移動データ
でロボットの制御を行う構成とする。
Description
御に係る制御装置およびその制御方法に関する。
ットのマニピュレータを動作させる場合において、その
教示点間の補間の方法としては次のように行うのが一般
的である。
を求める。そして、直交空間上の補間点を関節空間上の
補間点に逆変換して、関節空間上での隣り合う補間点間
の移動量とその移動時間を移動データとして生成する。
その移動データをロボットのマニピュレータの各関節を
駆動するモータへの指令として与える。
ら動作させるような、多関節形ロボットでは、直交空間
上ではマニピュレータ先端の移動速度は一定でも、関節
空間上での各関節軸の速度は必ずしも一定ではない。
は、関節軸の速度が急激に変化する場合がある。この速
度変化が急激過ぎると、関節軸を構成する減速機等の機
械要素に過大な負荷を与えることになり、機械寿命を短
くする。
許容値以外におさまるように教示しなおして教示速度を
下げる必要がある。しかしこれは、教示作業者には負担
となる。
ば、特開平6−19528号に示すような方法がある。
関節移動データを全て求めた上で、その関節移動データ
から関節速度をチェックする。このときに関節速度の変
化量が過大であれば、直交空間上でのマニピュレータ先
端速度を下げて再度補間をしなおす。このようにして、
関節速度の変化量が許容値以内におさまるように自動的
にマニピュレータの先端速度の調整がなされるようにし
ている。
うに教示点間の速度を一律に下げた場合、本来速度を下
げる必要のない部分も下げることになり、作業のタクト
タイムが大きくなってしまう。
て、作業のタクトタイムの増大を最小限にしながら、関
節軸の速度変化を低減することを目的とするものであ
る。
に請求項1記載の本発明は、移動量として移動速度と移
動時間からなる複数の移動データを記憶する手段を備
え、この記憶した各移動データに基づいて動作を制御す
るロボットの制御装置において、記憶した移動データか
らロボットの動作が所定の加速度を超えるか判断し、所
定の加速度を超えると判断した場合、該当する移動デー
タとその前後の移動データについて、移動量一定の条件
下で移動時間を増加させる手段と、これら移動時間を増
加させた移動データを記憶する手段を備え、この再度記
憶された移動データでロボットの制御を行う構成とす
る。
を超えると判断した場合に、該当する移動データの移動
時間を増加する割合に比べて、その前後の移動データの
移動時間を増加させる割合を小さくする手段を備えた請
求項1記載の構成とする。
を超えると判断した場合に、該当する移動データから離
れるに従って移動時間を増加する割合を小さくする手段
を備えた請求項1記載の構成とする。
を超えると判断した移動データを中心とした移動時間を
増加させる割合の分布を複数記憶する手段と、所定の加
速度を連続して超える場合に、前記記憶した分布の中で
一番割合の大きな分布を用いて移動時間を増加させる手
段を備えた請求項1から3のいずれかに記載の構成とす
る。
移動速度と移動時間からなる複数の移動データを記憶
し、この記憶した各移動データに基づいて動作を制御す
るロボットの制御方法において、記憶した移動データか
らロボットの動作が所定の加速度を超えるか判断し、所
定の加速度を超えると判断した場合、該当する移動デー
タとその前後の移動データについて、移動量一定の条件
下で移動時間を増加させ、これら移動時間を増加させた
移動データを記憶し、この再度記憶された移動データで
ロボットの制御を行う方法とする。
を超えると判断した場合に、該当する移動データの移動
時間を増加する割合に比べて、その前後の移動データの
移動時間を増加させる割合を小さくする請求項5記載の
方法とする。
を超えると判断した場合に、該当する移動データから離
れるに従って移動時間を増加する割合を小さくする請求
項5記載の方法とする。
を超えると判断した移動データを中心とした移動時間を
増加させる割合の分布を複数記憶し、所定の加速度を連
続して超える場合に、前記記憶した分布の中で一番割合
の大きな分布を用いて移動時間を増加させる請求項5か
ら7のいずれかに記載の方法とする。
ば、関節軸の速度変化が許容値を超える部分のみ速度を
下げるので、作業のタクトタイムの増大を最小限にしな
がら、関節軸の速度変化を低減することができるという
作用を有する。
ば、マニピュレータ先端の速度の不連続性を緩和しなが
ら、関節軸の速度変化を低減することができるという作
用を有する。
ば、マニピュレータ先端の速度が連続的に変化するよう
にしながら、関節軸の速度変化を低減することができる
という作用を有する。
ば、関節軸の速度変化が許容値を超える状態が続いた場
合でも、それを低減することができるという作用を有す
る。
構成を示すブロック図である。また、図2は、本発明の
第1の方法を示すフロー図である。
記憶するバッファである。移動データは各関節軸の移動
量と各関節軸共通の移動時間からなる。符号k〜k−4
はバッファ中の移動データの順番を示す。符号kに対応
する移動データは最新の移動データである。また、符号
k−4に対応する移動データは最古の移動データであ
り、各関節軸を駆動する指令データとして出力される。
ータを現在の移動データと称し、符号k−n(n=1〜
4)に対応する移動データをn個前の移動データと称す
る。
動データとから加速度を算出し、その結果に応じて補正
係数なるものを算出し、それを記憶部3に設定する部分
である。これについては後述する。
憶する部分である。ここに記憶した補正係数は、新しい
移動データが記憶部1に入力されるに同期して、右へシ
フトしていき、押し出された補正係数は演算部4に入力
される。
個前の移動データの移動時間との積を求め、それを1個
前の移動データの新たな移動時間として記憶部1の対応
する領域に記憶しなおす。
正係数の算出について以下に説明する。
間の加速度をα(k)とすれば、図9に示す符号を用い
ると式(1)のようである。
式(2)に示す値b(k)を各関節軸について求める。
を、B(k)とし、これからさらに補正係数β(k)を
式(3)または式(4)で求める。
正係数をβ(k−1)、1個後の移動データに対応する
補正係数をβ(k+1)とすれば、これらは式(5)で
求める。
−1)、β(k+1)を、記憶部3に記憶する。
構成を示すブロック図である。また、図4は、本発明の
第2の方法を示すフロー図である。
については、同じ符号を付して説明を省略し、異なる部
分のみ説明する。
算部5である。現在の移動データに対応する補正係数に
対して、1個前の移動データと1個後の移動データに対
応する補正係数の値を小さくする。
構成を示すブロック図である。また、図6は、本発明の
第3の方法を示すフロー図である。
については、同じ符号を付して説明を省略し、異なる部
分のみ説明する。
算部6と演算部8である。演算部6では、現在の移動デ
ータに対応する補正係数に対して、n個前までの移動デ
ータとn個後までの移動データに対応する補正係数の値
を求める。
構成を示すブロック図である。また、図8は、本発明の
第3の方法を示すフロー図である。
については、同じ符号を付して説明を省略し、異なる部
分のみ説明する。
算部9、記憶部10、記憶部11および、比較部20〜
28である。記憶部10の補正係数と記憶部11の補正
係数のそれぞれの補正係数どうしを比較して、大きい方
を採用して、それを記憶部11に記憶しなおす。
の第1の構成と方法によれば、関節軸の速度変化が許容
値を超える部分のみ速度を下げるので、作業のタクトタ
イムの増大を最小限にしながら、関節軸の速度変化を低
減することができる。
ば、マニピュレータ先端の速度の不連続性を緩和しなが
ら、関節軸の速度変化を低減することができる。
ば、マニピュレータ先端の速度が連続的に変化するよう
にしながら、関節軸の速度変化を低減することができ
る。
ば、関節軸の速度変化が許容値を超える状態が続いた場
合でも、それを低減することができる。
Claims (8)
- 【請求項1】 移動量として移動速度と移動時間からな
る複数の移動データを記憶する手段を備え、この記憶し
た各移動データに基づいて動作を制御するロボットの制
御装置において、記憶した移動データからロボットの動
作が所定の加速度を超えるか判断し、所定の加速度を超
えると判断した場合、該当する移動データとその前後の
移動データについて、移動量一定の条件下で移動時間を
増加させる手段と、これら移動時間を増加させた移動デ
ータを記憶する手段を設け、この再度記憶された移動デ
ータでロボットの制御を行うロボットの制御装置。 - 【請求項2】 所定の加速度を超えると判断した場合
に、該当する移動データの移動時間を増加する割合に比
べて、その前後の移動データの移動時間を増加させる割
合を小さくする手段を備えた請求項1記載のロボットの
制御装置。 - 【請求項3】 所定の加速度を超えると判断した場合
に、該当する移動データから離れるに従って移動時間を
増加する割合を小さくする手段を備えた請求項1記載の
ロボットの制御装置。 - 【請求項4】 所定の加速度を超えると判断した移動デ
ータを中心とした移動時間を増加させる割合の分布を複
数記憶する手段と、所定の加速度を連続して超える場合
に、前記記憶した分布の中で一番割合の大きな分布を用
いて移動時間を増加させる手段を備えた請求項1から3
のいずれかに記載のロボットの制御装置。 - 【請求項5】 移動量として移動速度と移動時間からな
る複数の移動データを記憶し、この記憶した各移動デー
タに基づいて動作を制御するロボットの制御方法におい
て、記憶した移動データからロボットの動作が所定の加
速度を超えるか判断し、所定の加速度を超えると判断し
た場合、該当する移動データとその前後の移動データに
ついて、移動量一定の条件下で移動時間を増加させ、こ
れら移動時間を増加させた移動データを記憶し、この再
度記憶された移動データでロボットの制御を行うロボッ
トの制御方法。 - 【請求項6】 所定の加速度を超えると判断した場合
に、該当する移動データの移動時間を増加する割合に比
べて、その前後の移動データの移動時間を増加させる割
合を小さくする請求項5記載のロボットの制御方法。 - 【請求項7】 所定の加速度を超えると判断した場合
に、該当する移動データから離れるに従って移動時間を
増加する割合を小さくする請求項5記載のロボットの制
御方法。 - 【請求項8】 所定の加速度を超えると判断した移動デ
ータを中心とした移動時間を増加させる割合の分布を複
数記憶し、所定の加速度を連続して超える場合に、前記
記憶した分布の中で一番割合の大きな分布を用いて移動
時間を増加させる請求項5から7のいずれかに記載のロ
ボットの制御方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001190960A JP2003001576A (ja) | 2001-06-25 | 2001-06-25 | ロボット制御装置およびその制御方法 |
US10/183,897 US6684131B2 (en) | 2001-06-25 | 2002-06-25 | Device and method for controlling robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001190960A JP2003001576A (ja) | 2001-06-25 | 2001-06-25 | ロボット制御装置およびその制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2003001576A true JP2003001576A (ja) | 2003-01-08 |
Family
ID=19029652
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2001190960A Pending JP2003001576A (ja) | 2001-06-25 | 2001-06-25 | ロボット制御装置およびその制御方法 |
Country Status (2)
Country | Link |
---|---|
US (1) | US6684131B2 (ja) |
JP (1) | JP2003001576A (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008538845A (ja) * | 2005-04-25 | 2008-11-06 | レニショウ パブリック リミテッド カンパニー | 経路計画方法 |
US8601701B2 (en) | 2007-04-23 | 2013-12-10 | Renishaw Plc | Apparatus and method for controlling or programming a measurement routine |
US8825438B2 (en) | 2007-08-20 | 2014-09-02 | Renishaw Plc | Course of motion determination |
JP2020179434A (ja) * | 2019-04-23 | 2020-11-05 | Arithmer株式会社 | 指定データ生成装置、指定データ生成方法、および指定データ生成プログラム |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8000837B2 (en) * | 2004-10-05 | 2011-08-16 | J&L Group International, Llc | Programmable load forming system, components thereof, and methods of use |
JP5231935B2 (ja) * | 2008-10-21 | 2013-07-10 | 株式会社東芝 | ロボット制御装置 |
DE102009049172B4 (de) * | 2009-10-13 | 2019-07-25 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zur Steuerung eines Manipulators |
IT1402158B1 (it) * | 2010-10-14 | 2013-08-28 | Agenzia Naz Per Le Nuove Tecnologie L En E Lo Sviluppo Economico Sostenibile Enea | Dispositivo e relativo procedimento per il controllo di manipolatori . |
DE102011010505A1 (de) * | 2011-02-07 | 2012-08-09 | Dürr Systems GmbH | Anpassung der Dynamik zumindest eines Roboters |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0074412B1 (en) * | 1981-03-23 | 1990-07-11 | Fanuc Ltd. | Numerical control system |
JP2935706B2 (ja) * | 1988-12-07 | 1999-08-16 | ファナック株式会社 | 加工プログラム修正方法 |
JP3341305B2 (ja) | 1992-06-30 | 2002-11-05 | ソニー株式会社 | 加減速パターン生成装置及び加減速パターン生成方法、並びにこれに用いる逆運動学問題の解法と時間軸補正方法 |
US5465605A (en) * | 1993-07-19 | 1995-11-14 | Smith; Gary W. H. | Floor covering foot impact simulator |
DE19857436A1 (de) * | 1998-12-12 | 2000-06-21 | Kuka Roboter Gmbh | Verfahren zum Behandeln des Spannungsabfalls in der Steuerung eines Roboters und zum Wiederanfahren eines Roboters nach Spannungsabfall |
US6386116B1 (en) * | 2000-06-23 | 2002-05-14 | Storage Technology Corporation | Propulsion decoupling method and system for multiple track mounted robots of an automated storage library |
-
2001
- 2001-06-25 JP JP2001190960A patent/JP2003001576A/ja active Pending
-
2002
- 2002-06-25 US US10/183,897 patent/US6684131B2/en not_active Expired - Lifetime
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008538845A (ja) * | 2005-04-25 | 2008-11-06 | レニショウ パブリック リミテッド カンパニー | 経路計画方法 |
US8601701B2 (en) | 2007-04-23 | 2013-12-10 | Renishaw Plc | Apparatus and method for controlling or programming a measurement routine |
US8825438B2 (en) | 2007-08-20 | 2014-09-02 | Renishaw Plc | Course of motion determination |
JP2020179434A (ja) * | 2019-04-23 | 2020-11-05 | Arithmer株式会社 | 指定データ生成装置、指定データ生成方法、および指定データ生成プログラム |
US11420321B2 (en) | 2019-04-23 | 2022-08-23 | Arithmer Inc. | Specifying data generating apparatus, specifying data generating method, and computer-readable medium having recorded thereon specifying data generating program |
Also Published As
Publication number | Publication date |
---|---|
US20030014156A1 (en) | 2003-01-16 |
US6684131B2 (en) | 2004-01-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5964488B1 (ja) | 保護動作制御部を有するモータ制御装置、ならびに機械学習装置およびその方法 | |
JP3900789B2 (ja) | モータの速度・加速度決定方法、加減速生成方法、加減速制御方法、加減速制御装置及びモータ制御装置 | |
JP4494247B2 (ja) | ロボットの制御装置および制御方法 | |
JP2003001576A (ja) | ロボット制御装置およびその制御方法 | |
JPH0969013A (ja) | サーボモータを用いたサーボ系の制御モード切り換え方法 | |
WO2018195689A1 (zh) | S型速度规划方法、装置、系统、机器人以及数控机床 | |
JPH07200033A (ja) | ロボット制御装置 | |
JPH0991025A (ja) | 動作デューティを考慮したロボットの最短時間制御方法 | |
JPH08126369A (ja) | ロボット制御装置 | |
JPH01131905A (ja) | ロボット・ジョイント制御方法 | |
JPH0916241A (ja) | ロボットの加減速動作の設定方法 | |
US20030173928A1 (en) | Servo control method | |
CN109491269B (zh) | 电动机控制装置以及电动机控制方法 | |
CN112596529B (zh) | 基于方向的机器人行走速度调节方法、芯片及视觉机器人 | |
JP3130426B2 (ja) | モータ制御装置 | |
JP4515408B2 (ja) | 位置決め制御装置 | |
JP6396389B2 (ja) | サーボ制御装置 | |
JPH0830975B2 (ja) | 多関節ロボットの制御方法 | |
JP2918269B2 (ja) | ロボットの移動制御方法 | |
JP2019021086A (ja) | 制御装置、制御装置の制御方法、情報処理プログラム、および記録媒体 | |
JPH06187045A (ja) | 位置決め装置 | |
JPH08263128A (ja) | ロボットの位置決め制御時の加減速制御方法 | |
JP2762789B2 (ja) | 多関節ロボットの加減速制御方法 | |
JP2002321178A (ja) | ロボットの加減速時間決定方法 | |
JP2765797B2 (ja) | ファジイ温度制御システム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20041220 |
|
RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20050701 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20060407 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060516 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060707 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20070123 |