JPH09204216A - 多関節ロボットの加減速制御方法 - Google Patents
多関節ロボットの加減速制御方法Info
- Publication number
- JPH09204216A JPH09204216A JP8030120A JP3012096A JPH09204216A JP H09204216 A JPH09204216 A JP H09204216A JP 8030120 A JP8030120 A JP 8030120A JP 3012096 A JP3012096 A JP 3012096A JP H09204216 A JPH09204216 A JP H09204216A
- Authority
- JP
- Japan
- Prior art keywords
- torque
- axis
- acceleration
- calculated
- angular acceleration
- 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.)
- Withdrawn
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】
【課題】 多関節ロボットの加減速制御方法において、
他の軸の動作から受ける反力を無視できないような動作
態様においても、減速機の破損及び寿命低下を防止でき
るようにする。 【解決手段】 多関節ロボットの各軸について、遠心力
及びコリオリ力によるトルクCi 、アンバランストルク
Pi 、及びモータの発生トルク限界Tmと減速機の許容
トルクTgのうちいづれか値の小さい方のトルク値とに
より、この軸のトルク余裕率ξi を算出し、算出された
全ての軸のトルク余裕率のうち最小の値をもつものを最
小トルク余裕率ξmin として抽出し、各軸について、前
記モータの発生トルク限界Tmと減速機の許容トルクT
gのうちいづれか値の小さい方のトルク値、最小トルク
余裕率ξmin 、及び軸のイナーシャJi とにより、各軸
の許容最大角加速度αmaxiを算出し、動作中の多関節ロ
ボットのi軸の角加速度αiが許容最大角加速度αmaxi
を超えないように加減速制御する。
他の軸の動作から受ける反力を無視できないような動作
態様においても、減速機の破損及び寿命低下を防止でき
るようにする。 【解決手段】 多関節ロボットの各軸について、遠心力
及びコリオリ力によるトルクCi 、アンバランストルク
Pi 、及びモータの発生トルク限界Tmと減速機の許容
トルクTgのうちいづれか値の小さい方のトルク値とに
より、この軸のトルク余裕率ξi を算出し、算出された
全ての軸のトルク余裕率のうち最小の値をもつものを最
小トルク余裕率ξmin として抽出し、各軸について、前
記モータの発生トルク限界Tmと減速機の許容トルクT
gのうちいづれか値の小さい方のトルク値、最小トルク
余裕率ξmin 、及び軸のイナーシャJi とにより、各軸
の許容最大角加速度αmaxiを算出し、動作中の多関節ロ
ボットのi軸の角加速度αiが許容最大角加速度αmaxi
を超えないように加減速制御する。
Description
【0001】
【発明の属する技術分野】本発明は、複数の駆動軸を有
する多関節ロボットの加減速時における制御方法に関す
る。
する多関節ロボットの加減速時における制御方法に関す
る。
【0002】
【従来の技術】複数の駆動軸を有する多関節ロボットに
おいては、駆動軸モータの特性やアームの形態等から各
軸の許容最大角加速度αmaxiを算出し、動作中のロボッ
トの各軸の角加速度αi がこの許容最大角加速度αmaxi
を超えないように制御される。そして、動作中のロボッ
トの許容最大角加速度αmax は、i軸の発生トルクτi
がこの軸の最大許容トルクTsplyi を超えないように制
限される。ここで、各軸の最大許容トルクTsplyi は、
各軸を駆動する駆動軸モータの発生トルク限界Tmと減
速機の許容トルクTgのうちいづれか値の小さい方のト
ルク値によって与えられる。
おいては、駆動軸モータの特性やアームの形態等から各
軸の許容最大角加速度αmaxiを算出し、動作中のロボッ
トの各軸の角加速度αi がこの許容最大角加速度αmaxi
を超えないように制御される。そして、動作中のロボッ
トの許容最大角加速度αmax は、i軸の発生トルクτi
がこの軸の最大許容トルクTsplyi を超えないように制
限される。ここで、各軸の最大許容トルクTsplyi は、
各軸を駆動する駆動軸モータの発生トルク限界Tmと減
速機の許容トルクTgのうちいづれか値の小さい方のト
ルク値によって与えられる。
【0003】一般に、i軸における発生トルクτi は、
i軸のイナーシャをJi (θ1,θ2,・・・,θn )、i
軸の角加速度をαi 、i軸における遠心力によるトルク
及びコリオリ力によるトルクをCi (ω1,ω2,・・・,
ωn 、θ1,θ2,・・・,θn)、i軸におけるアンバラ
ンストルクをPi (θ1,θ2,・・・,θn )とすると、
式(1)により与えられる。
i軸のイナーシャをJi (θ1,θ2,・・・,θn )、i
軸の角加速度をαi 、i軸における遠心力によるトルク
及びコリオリ力によるトルクをCi (ω1,ω2,・・・,
ωn 、θ1,θ2,・・・,θn)、i軸におけるアンバラ
ンストルクをPi (θ1,θ2,・・・,θn )とすると、
式(1)により与えられる。
【0004】
【数1】
【0005】式(1)において、(θ1,θ2,・・・,θ
n )は1軸〜n軸のアーム角度であり、(ω1,ω2,・・
・,ωn )は1軸〜n軸のアーム角速度である。式
(1)の左辺に各軸の最大許容トルクTsplyi を代入す
ると、各軸の許容最大角加速度αmaxiは式(2)に示す
ようになる。
n )は1軸〜n軸のアーム角度であり、(ω1,ω2,・・
・,ωn )は1軸〜n軸のアーム角速度である。式
(1)の左辺に各軸の最大許容トルクTsplyi を代入す
ると、各軸の許容最大角加速度αmaxiは式(2)に示す
ようになる。
【0006】
【数2】
【0007】多関節ロボットの実際の加減速制御では、
この許容最大角加速度αmaxiを超えないように各軸の角
加速度αi が制御されることになる。式(2)には各軸
の姿勢や角速度が考慮されているので、ロボットアーム
を比較的低速で動作させる場合においては、式(2)に
より算出された各軸の許容最大角加速度αmaxiに基づい
て各軸を制御することにより、減速機の破損及び寿命低
下を防止することが可能となる。
この許容最大角加速度αmaxiを超えないように各軸の角
加速度αi が制御されることになる。式(2)には各軸
の姿勢や角速度が考慮されているので、ロボットアーム
を比較的低速で動作させる場合においては、式(2)に
より算出された各軸の許容最大角加速度αmaxiに基づい
て各軸を制御することにより、減速機の破損及び寿命低
下を防止することが可能となる。
【0008】
【発明が解決しようとする課題】しかし、式(2)は他
の軸の動作から受ける力すなわち反力については考慮さ
れていないので、複数の軸が高速で同時に動作する場合
や急激な加減速を行う場合など、他の軸から受ける反力
を無視できないような動作態様においては、式(2)に
より算出された各軸の許容最大角加速度αmaxiに基づい
て各軸の角加速度αi を制御するようにすると、各軸の
最大許容トルクTsplyi を超すような場合が生じるとい
う問題がある。極端な場合には、動作中のある軸の角加
速度αi が0の場合でも、この軸の発生トルクτi が最
大許容トルクTsplyi を超すような場合が生じる。
の軸の動作から受ける力すなわち反力については考慮さ
れていないので、複数の軸が高速で同時に動作する場合
や急激な加減速を行う場合など、他の軸から受ける反力
を無視できないような動作態様においては、式(2)に
より算出された各軸の許容最大角加速度αmaxiに基づい
て各軸の角加速度αi を制御するようにすると、各軸の
最大許容トルクTsplyi を超すような場合が生じるとい
う問題がある。極端な場合には、動作中のある軸の角加
速度αi が0の場合でも、この軸の発生トルクτi が最
大許容トルクTsplyi を超すような場合が生じる。
【0009】本発明はこのような従来技術の問題点を解
決するためになされたものであり、複数の軸が高速で同
時に動作する場合や急激な加減速を行う場合など、他の
軸の動作から受ける反力を無視できないような動作態様
においても、軸の発生トルクτi が最大許容トルクT
splyi を超えることなく、減速機の破損及び寿命低下を
防止することができるような多関節ロボットの加減速制
御方法を提供することを目的としている。
決するためになされたものであり、複数の軸が高速で同
時に動作する場合や急激な加減速を行う場合など、他の
軸の動作から受ける反力を無視できないような動作態様
においても、軸の発生トルクτi が最大許容トルクT
splyi を超えることなく、減速機の破損及び寿命低下を
防止することができるような多関節ロボットの加減速制
御方法を提供することを目的としている。
【0010】
【課題を解決するための手段】上記の課題を解決するた
めに、本発明は、動作中の多関節ロボットの各軸の角度
θi 、角速度ωi 、及び角加速度αi が他の軸の動作か
ら受ける力すなわち反力の影響を受けるようにされてい
る多関節ロボットの加減速制御方法において、各軸につ
いて、遠心力及びコリオリ力によるトルクCi 、アンバ
ランストルクPi 、及びモータの発生トルク限界Tmと
減速機の許容トルクTgのうちいづれか値の小さい方の
トルク値すなわち最大許容トルクTsplyi とにより、各
軸のトルク余裕率ξi を算出し、算出された全ての軸の
トルク余裕率のうち最小の値をもつものを最小トルク余
裕率ξmin として抽出し、前記最大許容トルク
Tsplyi 、前記最小トルク余裕率ξmin 、及び軸のイナ
ーシャJi とにより、各軸の許容最大角加速度αmaxiを
算出し、動作中の多関節ロボットの全ての軸について、
各軸の角加速度αi がこの軸の許容最大角加速度αmaxi
を超えないように制御することにより、減速機の破損及
び寿命低下を防止するようにしたことを特徴とする多関
節ロボットの加減速制御方法を提供することとした。
めに、本発明は、動作中の多関節ロボットの各軸の角度
θi 、角速度ωi 、及び角加速度αi が他の軸の動作か
ら受ける力すなわち反力の影響を受けるようにされてい
る多関節ロボットの加減速制御方法において、各軸につ
いて、遠心力及びコリオリ力によるトルクCi 、アンバ
ランストルクPi 、及びモータの発生トルク限界Tmと
減速機の許容トルクTgのうちいづれか値の小さい方の
トルク値すなわち最大許容トルクTsplyi とにより、各
軸のトルク余裕率ξi を算出し、算出された全ての軸の
トルク余裕率のうち最小の値をもつものを最小トルク余
裕率ξmin として抽出し、前記最大許容トルク
Tsplyi 、前記最小トルク余裕率ξmin 、及び軸のイナ
ーシャJi とにより、各軸の許容最大角加速度αmaxiを
算出し、動作中の多関節ロボットの全ての軸について、
各軸の角加速度αi がこの軸の許容最大角加速度αmaxi
を超えないように制御することにより、減速機の破損及
び寿命低下を防止するようにしたことを特徴とする多関
節ロボットの加減速制御方法を提供することとした。
【0011】上記加減速制御方法により、本発明では、
各軸の許容最大角加速度αmaxiは、算出された各軸のト
ルク余裕率ξi のうち最小の値をもつ最小トルク余裕率
ξmin に基づいて決定される。
各軸の許容最大角加速度αmaxiは、算出された各軸のト
ルク余裕率ξi のうち最小の値をもつ最小トルク余裕率
ξmin に基づいて決定される。
【0012】
【発明の実施の形態】以下、本発明の実施形態について
図面を参照しながら具体的に説明する。図1は本発明の
制御方法を実施するためのシステムの一例を示すブロッ
ク図であり、図中1はロボット本体、2はサーボアン
プ、4は指令位置発生装置、5は目標位置発生装置、6
は許容最大角加速度αmaxiの計算装置である。目標位置
発生装置5は、メモリーに記録された位置または計算に
より求められた位置を、ロボットが到達すべき目標位置
として指令位置発生装置4へ出力する。指令位置発生装
置4は、目標位置、指定速度、現在位置、及び加速度制
限等の値から、ロボットが適正に動作するための時々刻
々の各軸の指令位置θi を算出し、サーボアンプ2へ出
力する。この指令位置発生装置4において行われる、各
軸が加速度制限を満たして動作するための方法について
は、例えば本願出願人が先に出願した特開平6−131
018号等に記載されており、またなめらかな加減速の
方法については同じく特開平5‐297916号に記載
されている。
図面を参照しながら具体的に説明する。図1は本発明の
制御方法を実施するためのシステムの一例を示すブロッ
ク図であり、図中1はロボット本体、2はサーボアン
プ、4は指令位置発生装置、5は目標位置発生装置、6
は許容最大角加速度αmaxiの計算装置である。目標位置
発生装置5は、メモリーに記録された位置または計算に
より求められた位置を、ロボットが到達すべき目標位置
として指令位置発生装置4へ出力する。指令位置発生装
置4は、目標位置、指定速度、現在位置、及び加速度制
限等の値から、ロボットが適正に動作するための時々刻
々の各軸の指令位置θi を算出し、サーボアンプ2へ出
力する。この指令位置発生装置4において行われる、各
軸が加速度制限を満たして動作するための方法について
は、例えば本願出願人が先に出願した特開平6−131
018号等に記載されており、またなめらかな加減速の
方法については同じく特開平5‐297916号に記載
されている。
【0013】許容最大角加速度αmaxiの計算装置6は、
本発明の制御方法において算出される許容最大角加速度
αmaxiの計算装置であり、指令位置発生装置4の出力で
ある指令位置θi を入力し、各軸の角速度ωi 、減速機
の許容トルクTg及び駆動軸モータの発生トルク限界T
mより許容最大角加速度αmaxiを算出し、指令位置発生
装置4へ出力するループを形成する。サーボアンプ2
は、指令位置発生装置4からの指令位置θi の入力を受
け、ロボット本体1を動作させるための動作指令を出力
する。ロボット本体1には図示しない駆動軸モータ、エ
ンコーダ、減速機等が取付られており、これらはサーボ
ル−プを構成する。
本発明の制御方法において算出される許容最大角加速度
αmaxiの計算装置であり、指令位置発生装置4の出力で
ある指令位置θi を入力し、各軸の角速度ωi 、減速機
の許容トルクTg及び駆動軸モータの発生トルク限界T
mより許容最大角加速度αmaxiを算出し、指令位置発生
装置4へ出力するループを形成する。サーボアンプ2
は、指令位置発生装置4からの指令位置θi の入力を受
け、ロボット本体1を動作させるための動作指令を出力
する。ロボット本体1には図示しない駆動軸モータ、エ
ンコーダ、減速機等が取付られており、これらはサーボ
ル−プを構成する。
【0014】図2は、図1において示した許容最大角加
速度αmaxiの計算装置6内にて行われる、許容最大角加
速度αmaxiの算出処理の流れを示すフローチャートであ
る。まず、指令位置発生装置4からロボットが適正に動
作するための各軸の指令位置θi を得(ステップ1
1)、この指令位置θi と、メモリに記憶しておいたθ
iよりも一定時間前の指令位置θi ′より、各軸の角速
度ωi を算出する(ステップ12)。この各軸の指令位
置θi 及び角速度ωi より、各軸のトルク余裕率ξi を
式(3)により算出する(ステップ13)。
速度αmaxiの計算装置6内にて行われる、許容最大角加
速度αmaxiの算出処理の流れを示すフローチャートであ
る。まず、指令位置発生装置4からロボットが適正に動
作するための各軸の指令位置θi を得(ステップ1
1)、この指令位置θi と、メモリに記憶しておいたθ
iよりも一定時間前の指令位置θi ′より、各軸の角速
度ωi を算出する(ステップ12)。この各軸の指令位
置θi 及び角速度ωi より、各軸のトルク余裕率ξi を
式(3)により算出する(ステップ13)。
【0015】
【数3】
【0016】式(3)において、Ci (ω1,ω2,・・
・,ωn 、θ1,θ2,・・・,θn )はi軸における遠心
力によるトルク及びコリオリ力によるトルクであり、P
i (θ1,θ2,・・・,θn )はi軸におけるアンバラン
ストルクである。また、Tsplyi は最大許容トルクであ
り、この値はモータの発生トルク限界Tmと減速機の許
容トルクTgのうちいづれか値の小さい方のトルク値に
よって与えられる。
・,ωn 、θ1,θ2,・・・,θn )はi軸における遠心
力によるトルク及びコリオリ力によるトルクであり、P
i (θ1,θ2,・・・,θn )はi軸におけるアンバラン
ストルクである。また、Tsplyi は最大許容トルクであ
り、この値はモータの発生トルク限界Tmと減速機の許
容トルクTgのうちいづれか値の小さい方のトルク値に
よって与えられる。
【0017】次に、式(4)に示すように、式(3)よ
り算出された各軸のトルク余裕率ξi のうち最小の値を
もつものを最小トルク余裕率ξmin として抽出する(ス
テップ14)。
り算出された各軸のトルク余裕率ξi のうち最小の値を
もつものを最小トルク余裕率ξmin として抽出する(ス
テップ14)。
【0018】
【数4】
【0019】次に、式(4)より算出された最小トルク
余裕率ξmin 、最大許容トルクTsp lyi 及び各軸のイナ
ーシャをJi (θ1,θ2,・・・,θn )より、各軸の許
容最大角加速度αmaxiを式(5)により算出する(ステ
ップ15)。
余裕率ξmin 、最大許容トルクTsp lyi 及び各軸のイナ
ーシャをJi (θ1,θ2,・・・,θn )より、各軸の許
容最大角加速度αmaxiを式(5)により算出する(ステ
ップ15)。
【0020】
【数5】
【0021】最後に、式(5)により算出された各軸の
許容最大角加速度αmaxiを指令位置発生装置4に出力す
る(ステップ16)。
許容最大角加速度αmaxiを指令位置発生装置4に出力す
る(ステップ16)。
【0022】次に、式(5)により算出された各軸の許
容最大角加速度αmaxiを加減速制御において使用すれ
ば、指令位置発生装置4が出力する各軸の指令位置θi
は、モータの発生トルク限界Tm及び減速機の許容トル
クTgを超えることはないことを示す。具体的には、式
(4)により、k軸のトルク余裕率ξk が1番低い値と
なったと仮定し、このトルク余裕率ξk が1番低いk軸
を許容最大角加速度αmaxkで動作させた場合における発
生トルクτk を算出してみる。式(5)により、k軸の
許容最大角加速度αmaxkは式(6)に示すようになる。
容最大角加速度αmaxiを加減速制御において使用すれ
ば、指令位置発生装置4が出力する各軸の指令位置θi
は、モータの発生トルク限界Tm及び減速機の許容トル
クTgを超えることはないことを示す。具体的には、式
(4)により、k軸のトルク余裕率ξk が1番低い値と
なったと仮定し、このトルク余裕率ξk が1番低いk軸
を許容最大角加速度αmaxkで動作させた場合における発
生トルクτk を算出してみる。式(5)により、k軸の
許容最大角加速度αmaxkは式(6)に示すようになる。
【0023】
【数6】
【0024】この式(6)に式(3)を代入すると、式
(6)は式(7)に示すように変形される。
(6)は式(7)に示すように変形される。
【0025】
【数7】
【0026】式(7)において、Pk (θ1,θ2,・・
・,θn )はk軸におけるアンバランストルクである。
さらに式(7)を式(1)に代入すると式(8)が得ら
れる。
・,θn )はk軸におけるアンバランストルクである。
さらに式(7)を式(1)に代入すると式(8)が得ら
れる。
【0027】
【数8】
【0028】式(8)より、トルク余裕率が1番低いk
軸をこの軸の許容最大角加速度αmaxkで動作させた場合
でも、このときの発生トルクはk軸の最大許容トルクT
splyk となり、駆動軸モータ及び減速機の許容限界をオ
ーバーしないことがわかる。
軸をこの軸の許容最大角加速度αmaxkで動作させた場合
でも、このときの発生トルクはk軸の最大許容トルクT
splyk となり、駆動軸モータ及び減速機の許容限界をオ
ーバーしないことがわかる。
【0029】
【実施例】図3は、本発明における加減速制御方法の従
来技術に対する効果を、実際の多関節ロボットの動作に
おいて実証したときの、トルク評価指数の時間経過を示
したものである。図3において、横軸は時間〔秒〕であ
り、縦軸はトルク評価指数である。ここで、トルク評価
指数とは、各軸において実際に指令値として確定した指
令位置θi 、角速度ωi 、及び角加速度αi を式(1)
に代入することにより、各軸の駆動軸モータの発生トル
クτi を求め、この発生トルクτi とこの軸の最大許容
トルクTsplyi との比(τi /Tsplyi )として表され
るものである。すべての軸においてトルク評価指数が常
に1以下であれば、ロボットは駆動軸モータ及び減速機
の最大許容トルク以下で常に動作していることになる。
来技術に対する効果を、実際の多関節ロボットの動作に
おいて実証したときの、トルク評価指数の時間経過を示
したものである。図3において、横軸は時間〔秒〕であ
り、縦軸はトルク評価指数である。ここで、トルク評価
指数とは、各軸において実際に指令値として確定した指
令位置θi 、角速度ωi 、及び角加速度αi を式(1)
に代入することにより、各軸の駆動軸モータの発生トル
クτi を求め、この発生トルクτi とこの軸の最大許容
トルクTsplyi との比(τi /Tsplyi )として表され
るものである。すべての軸においてトルク評価指数が常
に1以下であれば、ロボットは駆動軸モータ及び減速機
の最大許容トルク以下で常に動作していることになる。
【0030】図3に示す実施例においては、従来制御
(□印)では、トルク評価指数の最大値は約1.2とな
っており約20%のトルクオーバーが発生しているが、
本発明における制御(×印)では、トルク評価指数は常
時1.0以下を実現しておりトルクオーバーは発生して
いない。また、本発明の制御におけるトルク評価指数
は、従来制御のそれと比較して時間変動が小さく、した
がってロボットの軌跡精度の向上も図られていることが
わかる。
(□印)では、トルク評価指数の最大値は約1.2とな
っており約20%のトルクオーバーが発生しているが、
本発明における制御(×印)では、トルク評価指数は常
時1.0以下を実現しておりトルクオーバーは発生して
いない。また、本発明の制御におけるトルク評価指数
は、従来制御のそれと比較して時間変動が小さく、した
がってロボットの軌跡精度の向上も図られていることが
わかる。
【0031】
【発明の効果】以上のように、本発明における多関節ロ
ボットの加減速制御方法によれば、各軸の許容最大角加
速度αmaxiは算出された各軸のトルク余裕率ξi のうち
最小の値をもつ最小トルク余裕率ξmin に基づいて決定
されるので、複数の軸が高速で同時に動作する場合や急
激な加減速を行う場合など、他の軸の動作から受ける反
力を無視できないような動作態様においても、軸の発生
トルクが最大許容トルクを超えることはなく、これによ
り減速機の破損及び寿命低下を防止することができるよ
うになった。また、本発明によれば、駆動軸モータの出
し得るトルク内での加減速制御が保証されるようになっ
たため、ロボットの軌跡精度の向上を図ることもできる
ようになった。
ボットの加減速制御方法によれば、各軸の許容最大角加
速度αmaxiは算出された各軸のトルク余裕率ξi のうち
最小の値をもつ最小トルク余裕率ξmin に基づいて決定
されるので、複数の軸が高速で同時に動作する場合や急
激な加減速を行う場合など、他の軸の動作から受ける反
力を無視できないような動作態様においても、軸の発生
トルクが最大許容トルクを超えることはなく、これによ
り減速機の破損及び寿命低下を防止することができるよ
うになった。また、本発明によれば、駆動軸モータの出
し得るトルク内での加減速制御が保証されるようになっ
たため、ロボットの軌跡精度の向上を図ることもできる
ようになった。
【図1】本発明の制御方法を実施するためのシステムの
一例を示すブロック図である。
一例を示すブロック図である。
【図2】図1において示した許容最大角加速度αmaxiの
計算装置6内で行われる、許容最大角加速度αmaxiの算
出処理の流れを示すフローチャートである。
計算装置6内で行われる、許容最大角加速度αmaxiの算
出処理の流れを示すフローチャートである。
【図3】本発明における加減速制御方法の従来技術に対
する効果を、実際の多関節ロボットの動作において実証
したときの、トルク評価指数の時間経過を示したグラフ
である。
する効果を、実際の多関節ロボットの動作において実証
したときの、トルク評価指数の時間経過を示したグラフ
である。
Claims (1)
- 【請求項1】動作中の多関節ロボットの各軸の角度
θi 、角速度ωi 、及び角加速度αi が他の軸の動作か
ら受ける力すなわち反力の影響を受けるようにされてい
る多関節ロボットの加減速制御方法において、各軸につ
いて、遠心力及びコリオリ力によるトルクCi 、アンバ
ランストルクPi 、及びモータの発生トルク限界Tmと
減速機の許容トルクTgのうちいづれか値の小さい方の
トルク値すなわち最大許容トルクTsplyi とにより、各
軸のトルク余裕率ξi を算出し、算出された全ての軸の
トルク余裕率のうち最小の値をもつものを最小トルク余
裕率ξmin として抽出し、前記最大許容トルク
Tsplyi 、前記最小トルク余裕率ξmin 、及び軸のイナ
ーシャJi とにより、各軸の許容最大角加速度αmaxiを
算出し、動作中の多関節ロボットの全ての軸について、
各軸の角加速度αi がこの軸の許容最大角加速度αmaxi
を超えないように制御することにより、減速機の破損及
び寿命低下を防止するようにしたことを特徴とする多関
節ロボットの加減速制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP8030120A JPH09204216A (ja) | 1996-01-25 | 1996-01-25 | 多関節ロボットの加減速制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP8030120A JPH09204216A (ja) | 1996-01-25 | 1996-01-25 | 多関節ロボットの加減速制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH09204216A true JPH09204216A (ja) | 1997-08-05 |
Family
ID=12294929
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP8030120A Withdrawn JPH09204216A (ja) | 1996-01-25 | 1996-01-25 | 多関節ロボットの加減速制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH09204216A (ja) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100836240B1 (ko) * | 2001-11-01 | 2008-06-09 | 현대중공업 주식회사 | 로봇의 최적 가감속 제어방법 |
JP2008132595A (ja) * | 2008-02-08 | 2008-06-12 | Mitsubishi Electric Corp | ロボット制御装置 |
JP2011000674A (ja) * | 2009-06-18 | 2011-01-06 | Denso Wave Inc | ロボット制御装置 |
WO2013038543A1 (ja) * | 2011-09-15 | 2013-03-21 | 三菱電機株式会社 | 加工プログラム作成装置、数値制御装置、加工システム、加工プログラム作成方法、数値制御方法、および加工プログラム |
JP2014014875A (ja) * | 2012-07-05 | 2014-01-30 | Canon Inc | ロボット制御装置、及びロボット制御方法 |
JP2014014876A (ja) * | 2012-07-05 | 2014-01-30 | Canon Inc | ロボット制御装置、及びロボット制御方法 |
CN110053042A (zh) * | 2018-01-18 | 2019-07-26 | 发那科株式会社 | 机器人控制装置 |
WO2020255312A1 (ja) * | 2019-06-19 | 2020-12-24 | 三菱電機株式会社 | ロボットの動作調整装置、動作制御システムおよびロボットシステム |
-
1996
- 1996-01-25 JP JP8030120A patent/JPH09204216A/ja not_active Withdrawn
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100836240B1 (ko) * | 2001-11-01 | 2008-06-09 | 현대중공업 주식회사 | 로봇의 최적 가감속 제어방법 |
JP2008132595A (ja) * | 2008-02-08 | 2008-06-12 | Mitsubishi Electric Corp | ロボット制御装置 |
JP2011000674A (ja) * | 2009-06-18 | 2011-01-06 | Denso Wave Inc | ロボット制御装置 |
WO2013038543A1 (ja) * | 2011-09-15 | 2013-03-21 | 三菱電機株式会社 | 加工プログラム作成装置、数値制御装置、加工システム、加工プログラム作成方法、数値制御方法、および加工プログラム |
US9678500B2 (en) | 2011-09-15 | 2017-06-13 | Mitsubishi Electric Corporation | Machining program creating device numerical control device, machining system, machining program creating method, numerical control method, and machining program |
JP2014014875A (ja) * | 2012-07-05 | 2014-01-30 | Canon Inc | ロボット制御装置、及びロボット制御方法 |
JP2014014876A (ja) * | 2012-07-05 | 2014-01-30 | Canon Inc | ロボット制御装置、及びロボット制御方法 |
CN110053042A (zh) * | 2018-01-18 | 2019-07-26 | 发那科株式会社 | 机器人控制装置 |
US10814482B2 (en) | 2018-01-18 | 2020-10-27 | Fanuc Corporation | Robot controller |
CN110053042B (zh) * | 2018-01-18 | 2020-12-25 | 发那科株式会社 | 机器人控制装置 |
WO2020255312A1 (ja) * | 2019-06-19 | 2020-12-24 | 三菱電機株式会社 | ロボットの動作調整装置、動作制御システムおよびロボットシステム |
JPWO2020255312A1 (ja) * | 2019-06-19 | 2021-11-25 | 三菱電機株式会社 | ロボットの動作調整装置、動作制御システムおよびロボットシステム |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2604698B2 (ja) | 角加速度制御方法 | |
JP3900789B2 (ja) | モータの速度・加速度決定方法、加減速生成方法、加減速制御方法、加減速制御装置及びモータ制御装置 | |
WO2003068464A1 (fr) | Procede de commande d'entrainement et controleur d'entrainement | |
WO2007046257A1 (ja) | モータ制御装置及び方法及びプログラム記憶媒体 | |
JPWO2002066210A1 (ja) | ロボット制御装置 | |
JPH09204216A (ja) | 多関節ロボットの加減速制御方法 | |
JPH03130808A (ja) | ロボットの制御方法およびその制御装置 | |
JP2014014875A (ja) | ロボット制御装置、及びロボット制御方法 | |
JP2008194760A (ja) | ロボットアーム、及びその制御方法 | |
Farrage et al. | Time-optimal trajectory generation of rotary cranes with load sway reduction using only horizontal boom motion | |
Mohammed et al. | A fuzzy logic controller for electric powered wheelchair based on lagrange model | |
JPH1039916A (ja) | 多関節ロボットの加減速制御方法 | |
JP3607009B2 (ja) | 産業用ロボットの故障予知方法 | |
WO1999008167A1 (fr) | Procede permettant de generer une consigne d'acceleration/deceleration destinee a un robot industriel | |
EP0483756B1 (en) | Robot controlling method and apparatus | |
JP3204042B2 (ja) | ロボットの軌道の生成装置 | |
CN113635306B (zh) | 机器人紧急制动方法、机器人及存储介质 | |
JP2001216008A (ja) | ロボット制御方法 | |
CN111830992A (zh) | 一种轮式机器人的力控制方法、装置及轮式机器人 | |
JP3596682B2 (ja) | ロボットの加減速時間決定方法 | |
JP2002059382A (ja) | 多関節ロボットの制御方法 | |
JP3165087B2 (ja) | 産業用ロボットの故障検出方法 | |
CN114833836B (zh) | 一种高效的时间最优轨迹在线生成方法 | |
JPH1058368A (ja) | マニピュレータ制御装置 | |
JP3194829B2 (ja) | ロボットの動作プログラム生成装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20030401 |