JP4302805B2 - ロボット制御のための経路計画装置及び経路計画方法 - Google Patents
ロボット制御のための経路計画装置及び経路計画方法 Download PDFInfo
- Publication number
- JP4302805B2 JP4302805B2 JP36813498A JP36813498A JP4302805B2 JP 4302805 B2 JP4302805 B2 JP 4302805B2 JP 36813498 A JP36813498 A JP 36813498A JP 36813498 A JP36813498 A JP 36813498A JP 4302805 B2 JP4302805 B2 JP 4302805B2
- Authority
- JP
- Japan
- Prior art keywords
- operation control
- gain value
- movement operation
- profile
- robot movement
- 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.)
- Expired - Fee Related
Links
Images
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
-
- 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
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical 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/416—Numerical 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 control of velocity, acceleration or deceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
-
- 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/40225—During start up, control robot with low speed, after a while gradually higher
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41039—Change compensation slowly, gradually, smooth error with filter
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41148—Model, from position, speed, acceleration derive compensation
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
- Manipulator (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明はロボット制御に関するもので、より詳しくはロボットが動作する経路計画装置及び経路計画方法に関する。
【０００２】
【従来の技術】
産業用ロボットの動作を制御する場合には、動作経路が精密に維持され、線形又は環形の部分経路の間のコーナー組合せを単純で確実にすることが大変重要である。このために最近では平滑な加速及び減速を通じてロボットの動作経路を計画する方法が使われている。
【０００３】
図１に従来のロボットの経路計画装置のブロック図を図示した。
図１のように従来の経路計画装置は、目標位置の入力を受けて速度プロファイルを計算して出力するプランナー（planner）１０、プランナー１０から速度プロファイル（profile）の入力を受けて経路補間（path interpolation）を遂行して平滑化された速度プロファイルを出力する補間器（interpolator）２０、補間器２０の出力を受けてサーボモーター（servo motor）４０を制御するサーボ制御部３０とからなる。補間器２０は図２のように単位遅延素子（unit delay）２１と加算器（adder）２２及び係数乗算器（coefficient multiplier）２３で構成された線形フィルタとからなる。ここでＦはフィルタの次数（order）であり加／減速区間の長さになる。
【０００４】
かかる経路計画装置でプランナー１０が目標位置に至るために計算された速度プロファイルＶａを補間器２０に入力するとフィルタリングされた速度プロファイルＶｂが出力されサーボ制御部３０に入力されてサーボモーターを駆動するようになる。図３に入力速度プロファイルＶａを図示し、図４に出力速度プロファイルＶｂを図示した。
【０００５】
出力速度プロファイルＶｂを微分すると加速度プロファイルＡが求められ、これを再び微分するとジャークプロファイルＪを求めることができる。図４に加速度プロファイルＡとジャークプロファイルＪを各々図示した。ここでジャークは加速度の時間的変化率を指定するベクトルであって産業用ロボットにおけるロボットボディーの耐久性に大きな影響を及ぼす。図４のように従来の経路計画装置は急激なジャークを発生するのでロボットボディーに損傷を与えやすい。
【０００６】
かかるジャークの変化を減少させるためのアメリカ特許第５４３４４８９号明細書では二つの線形フィルタを使った経路計画装置を提示した。図５にこのような二つの線形フィルタを使った経路計画装置を図示した。図５のように補間器２０は二つの線形フィルタ２４，２５よりなっている。この場合、図３のような速度プロファイルＶａが補間器２０に入力されると、図６のような速度プロファイルＶｂが出力される。図６の速度プロファイルＶｂにおける加／減速部分は２次関数よりなるＳ字曲線の形態になっていることがわかる。
【０００７】
図６の速度プロファイルＶｂから加速度プロファイルＡおよびジャークプロファイルＪが求められ、これを図６に併せて図示した。図６のように二つの線形フィルタを使った場合には一つの線形フィルタを使った場合よりジャークプロファイルＪが緩やかになるので、ボットボディーの損傷を減少させて円滑な動作が得られる。しかし、依然としてジャークの変化が大きくてロボットボディーが損傷するおそれがあり、フィルタの過剰な使用によって、計算時間が増えて応答速度が遅くなると言う短所がある。
【０００８】
【発明が解決しようとする課題】
本発明はかかる問題点を解決するためのもので、本発明の課題はロボットの経路計画装置でジャークの変化を緩やかにすることによりロボットボディーの損傷を軽減し、動きを円滑にして、経路計画装置の応答速度を改善することである。
【０００９】
【課題を解決するための手段】
かかる課題を達成するために本発明では、設定された目標に対する位置信号の入力を受けて速度プロファイルを計算し、一つの低域通過フィルタを使って速度プロファイルに対して経路補間を遂行することで、平滑化された速度プロファイルを形成してサーボモーターの加／減速を制御する。
【００１０】
かかる経路計画に使われる低域通過フィルタは直列接続された多数の単位遅延素子と係数乗算器及び加算器からなる。フィルタに入力された信号は単位遅延素子によって順次に遅延する。このように遅延した各信号に所定の利得値を係数乗算器で乗算して、この値を加算器ですべて加算した後、ここに前記利得値の全体の和の逆数がまた他の係数乗算器で乗算されてフィルタ出力になる。
【００１１】
ここで、利得値を調節してサーボモーターの加速度の変化率を調節することができ、利得値を時間に対する関数で表わした時、その次数が大きければ大きいほどサーボモーターの動作がスムーズになる。すなわち、フィルタに入力される速度プロファイルが０次である時、利得値が時間に対して１次関数である場合にはジャークプロファイルは０次になり、利得値が時間に対して２次関数である場合にはジャークプロファイルは１次になってさらに平滑化される。このようにジャークプロファイルを平滑化させる経路計画はロボット制御に使われる場合、ロボットボディーの損傷を減少させることができる。
【００１２】
【発明の実施の形態】
以下、本発明のもっとも好ましい実施形態を記載する。
本発明の実施形態による経路計画装置を図７に図示した。図７のように本発明による経路計画装置は目標に対する位置信号の入力を受けて速度プロファイルＶａを計算して出力するプランナー１０と、プランナー１０から速度プロファイルＶａの入力を受けて平滑化された速度プロファイルＶｂを出力する低域通過フィルタ５０と、低域通過フィルタ５０の出力を受けてサーボモーター４０の加／減速を制御するサーボ制御部３０とからなる。低域通過フィルタ５０は経路補間を遂行する補間器の機能を有する。すなわち、本発明による実施形態では一つの低域通過フィルタ５０だけで経路補間を遂行することができる。
【００１３】
かかる低域通過フィルタ５０を図８に図示した。図８のように、低域通過フィルタ５０はシフトレジスタで形成されている多数の単位遅延素子５１と係数乗算器５２、５４及び加算器５３からなる。単位遅延素子５１は直列接続されて遅延した信号を出力し、係数乗算器５２は遅延した各々の信号に所定の利得値ｋ1、ｋ2、…、ｋFを乗じ、加算器５３は係数乗算器５２の各出力をすべて加算し、係数乗算器５４は係数乗算器５２でに乗算された利得値ｋ1、ｋ2、…、ｋF全体の和の逆数１／Ｓkを加算器５３の出力値に乗算する。ここでＦはサーボモーターの加／減速区間の大きさである。
【００１４】
一般に、デジタルフィルタの伝達関数がｆ(ｎＴ)であり、フィルタの入力信号がＶ(ｎＴ)である時、フィルタ出力ｗ(ｎＴ)は次の数５のように入力信号Ｖ(ｎＴ)と伝達関数のｆ(ｎＴ)のコンボルション（convolution）で表示される。ここでＴはサンプリング周期であり、ｎ＝０、１、２、…である。
【００１５】
【数５】
【００１６】
従って、前記低域通過フィルタ５０に速度プロファイルＶａ（ｎＴ）が入力されると、出力される速度プロファイルＶｂ（ｎＴ）は次の数６の通りである。
【００１７】
【数６】
【００１８】
図８のように実際にフィルタを具現する場合には各利得値の合計Ｓkは初期値として設定されるのでフィルタの計算速度にはあまり影響を与えない。
【００１９】
上記数６の利得値ｋiによってサーボモーター４０の加速度の変化率が決定される。便宜上利得値ｋiを時間ｔに対する連続関数ｋ(ｔ)で表現し、ｋ(ｔ)が次の数７のような時間に対する１次関数の関係を有すると、低域通過フィルタ５０は図３のような速度プロファイルＶａが入力された時、図６のような速度プロファイルＶｂを出力する。
【００２０】
【数７】
【００２１】
ここで、ａは任意の正数で、数７の関係を図９にグラフで図示した。かかる利得値ｋ(ｔ)は低域通過フィルタ５０がデジタルフィルタであるので実際には０からＦまでの期間の間にサンプリングの周期Ｔでサンプリング処理される。図６の速度プロファイルＶｂにおいて加／減速部分は２次関数からなっているＳ字曲線の形態を有する。
【００２２】
かかる速度プロファイルＶｂを微分すると図６のような加速度プロファイルＡとジャークプロファイルＪを得ることができる。すなわち、従来の二つの線型フィルタを使った場合のようなジャークプロファイルＪを一つの低域通過フィルタだけで得ることができる。
【００２３】
これと異なり、利得値ｋ(ｔ)が次の数８のような時間に対する２次関数の関係を有すると、低域通過フィルタ５０は図３のような速度プロファイルＶａが入力された時に図１１のような速度プロファイルＶｂを出力する。
【００２４】
【数８】
【００２５】
ここでａは任意の正数で、上記数８の関係を図１０にグラフで図示した。図１１の速度プロファイルＶｂを微分すると図１１の加速度プロファイルＡとジャークプロファイルＪを得ることができる。この場合にはジャークプロファイルＪが図６に図示したものよりはるかに平滑化されてサーボモーターがよりスムーズに動作できる。
【００２６】
かかるように利得値の次数が大きければ大きいほどジャークプロファイルが平滑化されてジャークによってロボットボディーに与えられる損傷を減少させることができる。
【００２７】
以下、本発明の実施形態による経路計画方法を説明する。
まず、設定された目標に対する位置信号の入力を受けて速度プロファイルＶａを計算し、速度プロファイルＶａに対して経路補間を遂行して平滑化された速度プロファイルＶｂを形成し、速度プロファイルＶｂでサーボモーターの加／減速を制御して経路計画を遂行する。この時、経路補間は一つの低域通過フィルタを使ってフィルタリングすることによって遂行される。
【００２８】
低域通過フィルタを使ってフィルタリングする方法は、入力信号を連続的に遅延させて順次の遅延値を有する多数の遅延信号を形成し、遅延信号に各々の利得値を乗じて出力した後、利得値が乗算された各出力を合わせた値に利得値全体の和の逆数を乗じてフィルタリングする。ここで利得値の全体の和の逆数に対する計算はフィルタリングする前に予め計算して初期値として設定することによってフィルタリングにかかる時間を減少させることができる。
【００２９】
かかる低域通過フィルタの利得値を調節することで、サーボモーターの加速度の変化率を調節することができる。利得値を時間に対する連続関数で表現する時、関数の次数が大きければ大きいほどサーボモーターの動作がスムーズになる。すなわち、低域通過フィルタに入力される速度プロファイルが０次である時、利得値が時間に対する１次関数である場合にはジャークプロファイルは０次になり、利得値が時間に対する２次関数である場合にはジャークプロファイルは１次になる。
ロボットの制御では、かかるジャークプロファイルの次数が増加して平滑化されればされるほどロボットボディーの損傷を減少させることができる。
【００３０】
【発明の効果】
前記のように本発明による経路制御では一つの低域通過フィルタの利得値を調節して経路補間を遂行することによってサーボモーターの動作をスムーズにし、ロボット制御に使う場合、ジャークの変化が緩やかになってロボットボディーに対する損傷を減少させることができる。また低域通過フィルタを具現する場合、利得値の和を加／減速区間が与えられると予めて計算することができるのでフィルタの計算速度を増加させることができる。
【図面の簡単な説明】
【図１】 従来のロボット制御における経路計画装置を図示したブロック図である。
【図２】 図１の経路計画装置の補間器として使われる線形フィルタを図示したブロック図である。
【図３】 図１の補間器に入力される速度プロファイルを図示したグラフである。
【図４】 図１の補間器に出力される速度プロファイルとこれを微分した加速度プロファイル及びジャークプロファイルを図示したグラフである。
【図５】 二つの線形フィルタを使った従来の経路計画装置の補間器を図示したブロック図である。
【図６】 図５の補間器から出力される速度プロファイルとこれを微分した加速度プロファイル及びジャークプロファイルを図示したグラフである。
【図７】 本発明の実施形態による経路計画装置を図示したブロック図である。
【図８】 図７の経路計画装置の補間器に使われる低域通過フィルタを図示したブロック図である。
【図９】 図８の低域通過フィルタの利得値を図示したグラフである。
【図１０】 図８の低域通過フィルタの利得値を図示したグラフである。
【図１１】 図８の低域通過フィルタから出力される速度プロファイルとこれを微分した加速度プロファイル及びジャークプロファイルを図示したグラフである。
【符号の説明】
１０ プランナー
３０ サーボ制御部
４０ サーボモーター
５０ 低域通過フィルタ
５１ 単位遅延素子
５２ 係数乗算器
５３ 加算器
【発明の属する技術分野】
本発明はロボット制御に関するもので、より詳しくはロボットが動作する経路計画装置及び経路計画方法に関する。
【０００２】
【従来の技術】
産業用ロボットの動作を制御する場合には、動作経路が精密に維持され、線形又は環形の部分経路の間のコーナー組合せを単純で確実にすることが大変重要である。このために最近では平滑な加速及び減速を通じてロボットの動作経路を計画する方法が使われている。
【０００３】
図１に従来のロボットの経路計画装置のブロック図を図示した。
図１のように従来の経路計画装置は、目標位置の入力を受けて速度プロファイルを計算して出力するプランナー（planner）１０、プランナー１０から速度プロファイル（profile）の入力を受けて経路補間（path interpolation）を遂行して平滑化された速度プロファイルを出力する補間器（interpolator）２０、補間器２０の出力を受けてサーボモーター（servo motor）４０を制御するサーボ制御部３０とからなる。補間器２０は図２のように単位遅延素子（unit delay）２１と加算器（adder）２２及び係数乗算器（coefficient multiplier）２３で構成された線形フィルタとからなる。ここでＦはフィルタの次数（order）であり加／減速区間の長さになる。
【０００４】
かかる経路計画装置でプランナー１０が目標位置に至るために計算された速度プロファイルＶａを補間器２０に入力するとフィルタリングされた速度プロファイルＶｂが出力されサーボ制御部３０に入力されてサーボモーターを駆動するようになる。図３に入力速度プロファイルＶａを図示し、図４に出力速度プロファイルＶｂを図示した。
【０００５】
出力速度プロファイルＶｂを微分すると加速度プロファイルＡが求められ、これを再び微分するとジャークプロファイルＪを求めることができる。図４に加速度プロファイルＡとジャークプロファイルＪを各々図示した。ここでジャークは加速度の時間的変化率を指定するベクトルであって産業用ロボットにおけるロボットボディーの耐久性に大きな影響を及ぼす。図４のように従来の経路計画装置は急激なジャークを発生するのでロボットボディーに損傷を与えやすい。
【０００６】
かかるジャークの変化を減少させるためのアメリカ特許第５４３４４８９号明細書では二つの線形フィルタを使った経路計画装置を提示した。図５にこのような二つの線形フィルタを使った経路計画装置を図示した。図５のように補間器２０は二つの線形フィルタ２４，２５よりなっている。この場合、図３のような速度プロファイルＶａが補間器２０に入力されると、図６のような速度プロファイルＶｂが出力される。図６の速度プロファイルＶｂにおける加／減速部分は２次関数よりなるＳ字曲線の形態になっていることがわかる。
【０００７】
図６の速度プロファイルＶｂから加速度プロファイルＡおよびジャークプロファイルＪが求められ、これを図６に併せて図示した。図６のように二つの線形フィルタを使った場合には一つの線形フィルタを使った場合よりジャークプロファイルＪが緩やかになるので、ボットボディーの損傷を減少させて円滑な動作が得られる。しかし、依然としてジャークの変化が大きくてロボットボディーが損傷するおそれがあり、フィルタの過剰な使用によって、計算時間が増えて応答速度が遅くなると言う短所がある。
【０００８】
【発明が解決しようとする課題】
本発明はかかる問題点を解決するためのもので、本発明の課題はロボットの経路計画装置でジャークの変化を緩やかにすることによりロボットボディーの損傷を軽減し、動きを円滑にして、経路計画装置の応答速度を改善することである。
【０００９】
【課題を解決するための手段】
かかる課題を達成するために本発明では、設定された目標に対する位置信号の入力を受けて速度プロファイルを計算し、一つの低域通過フィルタを使って速度プロファイルに対して経路補間を遂行することで、平滑化された速度プロファイルを形成してサーボモーターの加／減速を制御する。
【００１０】
かかる経路計画に使われる低域通過フィルタは直列接続された多数の単位遅延素子と係数乗算器及び加算器からなる。フィルタに入力された信号は単位遅延素子によって順次に遅延する。このように遅延した各信号に所定の利得値を係数乗算器で乗算して、この値を加算器ですべて加算した後、ここに前記利得値の全体の和の逆数がまた他の係数乗算器で乗算されてフィルタ出力になる。
【００１１】
ここで、利得値を調節してサーボモーターの加速度の変化率を調節することができ、利得値を時間に対する関数で表わした時、その次数が大きければ大きいほどサーボモーターの動作がスムーズになる。すなわち、フィルタに入力される速度プロファイルが０次である時、利得値が時間に対して１次関数である場合にはジャークプロファイルは０次になり、利得値が時間に対して２次関数である場合にはジャークプロファイルは１次になってさらに平滑化される。このようにジャークプロファイルを平滑化させる経路計画はロボット制御に使われる場合、ロボットボディーの損傷を減少させることができる。
【００１２】
【発明の実施の形態】
以下、本発明のもっとも好ましい実施形態を記載する。
本発明の実施形態による経路計画装置を図７に図示した。図７のように本発明による経路計画装置は目標に対する位置信号の入力を受けて速度プロファイルＶａを計算して出力するプランナー１０と、プランナー１０から速度プロファイルＶａの入力を受けて平滑化された速度プロファイルＶｂを出力する低域通過フィルタ５０と、低域通過フィルタ５０の出力を受けてサーボモーター４０の加／減速を制御するサーボ制御部３０とからなる。低域通過フィルタ５０は経路補間を遂行する補間器の機能を有する。すなわち、本発明による実施形態では一つの低域通過フィルタ５０だけで経路補間を遂行することができる。
【００１３】
かかる低域通過フィルタ５０を図８に図示した。図８のように、低域通過フィルタ５０はシフトレジスタで形成されている多数の単位遅延素子５１と係数乗算器５２、５４及び加算器５３からなる。単位遅延素子５１は直列接続されて遅延した信号を出力し、係数乗算器５２は遅延した各々の信号に所定の利得値ｋ1、ｋ2、…、ｋFを乗じ、加算器５３は係数乗算器５２の各出力をすべて加算し、係数乗算器５４は係数乗算器５２でに乗算された利得値ｋ1、ｋ2、…、ｋF全体の和の逆数１／Ｓkを加算器５３の出力値に乗算する。ここでＦはサーボモーターの加／減速区間の大きさである。
【００１４】
一般に、デジタルフィルタの伝達関数がｆ(ｎＴ)であり、フィルタの入力信号がＶ(ｎＴ)である時、フィルタ出力ｗ(ｎＴ)は次の数５のように入力信号Ｖ(ｎＴ)と伝達関数のｆ(ｎＴ)のコンボルション（convolution）で表示される。ここでＴはサンプリング周期であり、ｎ＝０、１、２、…である。
【００１５】
【数５】
従って、前記低域通過フィルタ５０に速度プロファイルＶａ（ｎＴ）が入力されると、出力される速度プロファイルＶｂ（ｎＴ）は次の数６の通りである。
【００１７】
【数６】
図８のように実際にフィルタを具現する場合には各利得値の合計Ｓkは初期値として設定されるのでフィルタの計算速度にはあまり影響を与えない。
【００１９】
上記数６の利得値ｋiによってサーボモーター４０の加速度の変化率が決定される。便宜上利得値ｋiを時間ｔに対する連続関数ｋ(ｔ)で表現し、ｋ(ｔ)が次の数７のような時間に対する１次関数の関係を有すると、低域通過フィルタ５０は図３のような速度プロファイルＶａが入力された時、図６のような速度プロファイルＶｂを出力する。
【００２０】
【数７】
ここで、ａは任意の正数で、数７の関係を図９にグラフで図示した。かかる利得値ｋ(ｔ)は低域通過フィルタ５０がデジタルフィルタであるので実際には０からＦまでの期間の間にサンプリングの周期Ｔでサンプリング処理される。図６の速度プロファイルＶｂにおいて加／減速部分は２次関数からなっているＳ字曲線の形態を有する。
【００２２】
かかる速度プロファイルＶｂを微分すると図６のような加速度プロファイルＡとジャークプロファイルＪを得ることができる。すなわち、従来の二つの線型フィルタを使った場合のようなジャークプロファイルＪを一つの低域通過フィルタだけで得ることができる。
【００２３】
これと異なり、利得値ｋ(ｔ)が次の数８のような時間に対する２次関数の関係を有すると、低域通過フィルタ５０は図３のような速度プロファイルＶａが入力された時に図１１のような速度プロファイルＶｂを出力する。
【００２４】
【数８】
ここでａは任意の正数で、上記数８の関係を図１０にグラフで図示した。図１１の速度プロファイルＶｂを微分すると図１１の加速度プロファイルＡとジャークプロファイルＪを得ることができる。この場合にはジャークプロファイルＪが図６に図示したものよりはるかに平滑化されてサーボモーターがよりスムーズに動作できる。
【００２６】
かかるように利得値の次数が大きければ大きいほどジャークプロファイルが平滑化されてジャークによってロボットボディーに与えられる損傷を減少させることができる。
【００２７】
以下、本発明の実施形態による経路計画方法を説明する。
まず、設定された目標に対する位置信号の入力を受けて速度プロファイルＶａを計算し、速度プロファイルＶａに対して経路補間を遂行して平滑化された速度プロファイルＶｂを形成し、速度プロファイルＶｂでサーボモーターの加／減速を制御して経路計画を遂行する。この時、経路補間は一つの低域通過フィルタを使ってフィルタリングすることによって遂行される。
【００２８】
低域通過フィルタを使ってフィルタリングする方法は、入力信号を連続的に遅延させて順次の遅延値を有する多数の遅延信号を形成し、遅延信号に各々の利得値を乗じて出力した後、利得値が乗算された各出力を合わせた値に利得値全体の和の逆数を乗じてフィルタリングする。ここで利得値の全体の和の逆数に対する計算はフィルタリングする前に予め計算して初期値として設定することによってフィルタリングにかかる時間を減少させることができる。
【００２９】
かかる低域通過フィルタの利得値を調節することで、サーボモーターの加速度の変化率を調節することができる。利得値を時間に対する連続関数で表現する時、関数の次数が大きければ大きいほどサーボモーターの動作がスムーズになる。すなわち、低域通過フィルタに入力される速度プロファイルが０次である時、利得値が時間に対する１次関数である場合にはジャークプロファイルは０次になり、利得値が時間に対する２次関数である場合にはジャークプロファイルは１次になる。
ロボットの制御では、かかるジャークプロファイルの次数が増加して平滑化されればされるほどロボットボディーの損傷を減少させることができる。
【００３０】
【発明の効果】
前記のように本発明による経路制御では一つの低域通過フィルタの利得値を調節して経路補間を遂行することによってサーボモーターの動作をスムーズにし、ロボット制御に使う場合、ジャークの変化が緩やかになってロボットボディーに対する損傷を減少させることができる。また低域通過フィルタを具現する場合、利得値の和を加／減速区間が与えられると予めて計算することができるのでフィルタの計算速度を増加させることができる。
【図面の簡単な説明】
【図１】 従来のロボット制御における経路計画装置を図示したブロック図である。
【図２】 図１の経路計画装置の補間器として使われる線形フィルタを図示したブロック図である。
【図３】 図１の補間器に入力される速度プロファイルを図示したグラフである。
【図４】 図１の補間器に出力される速度プロファイルとこれを微分した加速度プロファイル及びジャークプロファイルを図示したグラフである。
【図５】 二つの線形フィルタを使った従来の経路計画装置の補間器を図示したブロック図である。
【図６】 図５の補間器から出力される速度プロファイルとこれを微分した加速度プロファイル及びジャークプロファイルを図示したグラフである。
【図７】 本発明の実施形態による経路計画装置を図示したブロック図である。
【図８】 図７の経路計画装置の補間器に使われる低域通過フィルタを図示したブロック図である。
【図９】 図８の低域通過フィルタの利得値を図示したグラフである。
【図１０】 図８の低域通過フィルタの利得値を図示したグラフである。
【図１１】 図８の低域通過フィルタから出力される速度プロファイルとこれを微分した加速度プロファイル及びジャークプロファイルを図示したグラフである。
【符号の説明】
１０ プランナー
３０ サーボ制御部
４０ サーボモーター
５０ 低域通過フィルタ
５１ 単位遅延素子
５２ 係数乗算器
５３ 加算器
Claims (13)
- ロボットの移動動作の目標位置に対する位置信号の入力を受けて、該ロボットの移動速度と該移動速度での動作時間との関係を示す信号である速度プロファイルＶａを計算して出力するプランナーと、
前記プランナーから前記速度プロファイルＶａの入力を受けて速度プロファイルＶｂを出力する一つの低域通過フィルタと、
前記低域通過フィルタの出力を受けてサーボモーターの加／減速を制御するサーボ制御部とを含み、
前記低域通過フィルタは
前記速度プロファイルＶａを入力する直列接続された多数の単位遅延素子と、
前記単位遅延素子の出力の各々に利得値を乗じる多数の第１係数乗算器と、
前記多数の第１係数乗算器の出力をすべて加える加算器と、
前記加算器の出力に前記利得値全体の和の逆数を乗じる第２係数乗算器とを含み、
前記単位遅延素子は、入力した信号を所定時間だけ遅延させて出力するものであるロボットの移動動作制御装置。 - 前記単位遅延素子はシフトレジスタで形成される請求項１に記載のロボットの移動動作制御装置。
- 前記利得値は時間に対して１次関数の関係を有する請求項１に記載のロボットの移動動作制御装置。
- 時間をｔとし、前記利得値をｋ(ｔ)とし、前記サーボモーター加／減速区間の大きさをＦとし、任意の正数をａとする時、前記１次関数は下記数式の通りである請求項３に記載のロボットの移動動作制御装置。
- 前記利得値は時間に対して２次関数の関係を有する請求項１に記載のロボットの移動動作制御装置。
- 時間をｔとし、前記利得値をｋ(ｔ)とし、前記サーボモーター加／減速区間の大きさをＦとし、任意の正数をａとする時、前記２次関数は下記数式の通りである請求項５に記載のロボットの移動動作制御装置。
- ロボットの移動動作の目標位置に対する位置信号の入力を受けて、該ロボットの移動速度と該移動速度での動作時間との関係を示す信号である速度プロファイルＶａを計算する段階と、
一つの低域通過フィルタを使って前記速度プロファイルＶａに対してフィルタリングして速度プロファイルＶｂを形成する段階と、
前記速度プロファイルＶｂでサーボモーターの加／減速を制御する段階とを含み、
前記速度プロファイルＶｂを形成する段階は、
入力信号である前記速度プロファイルＶａを連続的に遅延させて順次の遅延値を有する多数の遅延信号を形成する段階と、
前記遅延信号の各々に利得値を乗じて出力する段階と、
前記利得値が乗じられた各出力を加算した値に前記利得値全体の和の逆数を乗じる段階とを含み、
前記単位遅延素子は、入力した信号を所定時間だけ遅延させて出力するものであるロボットの移動動作制御方法。 - 前記利得値全体の和の計算はフィルタが動作する前に予め計算されて初期値として設定される請求項７に記載のロボットの移動動作制御方法。
- 前記利得値を調節してサーボモーターの加速度の変化率を調節する請求項７に記載のロボットの移動動作制御方法。
- 前記利得値は時間に対して１次関数の関係を有する請求項７に記載のロボットの移動動作制御方法。
- 時間をｔとし、前記利得値をｋ(ｔ)とし、前記補間器の加／減速区間の大きさをＦとし、任意の正数をａとする時、前記１次関数は下記数式の通りである請求項１０に記載のロボットの移動動作制御方法。
- 前記利得値は時間に対して２次関数の関係を有する請求項７に記載のロボットの移動動作制御方法。
- 時間をｔとし、前記利得値をｋ(ｔ)とし、前記補間器の加／減速区間の大きさをＦとし、任意の正数をａとする時、前記２次関数は下記数式の通りである請求項１２に記載のロボットの移動動作制御方法。
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR199780191 | 1997-12-31 | ||
| KR1019970080191A KR100242447B1 (ko) | 1997-12-31 | 1997-12-31 | 로봇 제어를 위한 경로 계획 장치 및 경로 계획 방법 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH11249724A JPH11249724A (ja) | 1999-09-17 |
| JP4302805B2 true JP4302805B2 (ja) | 2009-07-29 |
Family
ID=19530260
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP36813498A Expired - Fee Related JP4302805B2 (ja) | 1997-12-31 | 1998-12-24 | ロボット制御のための経路計画装置及び経路計画方法 |
Country Status (4)
| Country | Link |
|---|---|
| US (1) | US6046564A (ja) |
| JP (1) | JP4302805B2 (ja) |
| KR (1) | KR100242447B1 (ja) |
| CN (1) | CN1064577C (ja) |
Families Citing this family (21)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| UA77662C2 (en) * | 2000-10-10 | 2007-01-15 | Dbt America Inc | Automated continuous haulage apparatus |
| KR100877983B1 (ko) * | 2002-03-11 | 2009-01-12 | 주식회사 엘지이아이 | 로봇의 목표물 추종장치 및 방법 |
| KR100540588B1 (ko) * | 2002-12-27 | 2006-01-10 | 삼성중공업 주식회사 | 모션 제어의 실시간 응답을 위한 궤적발생방법 및 시스템 |
| JP3994950B2 (ja) * | 2003-09-19 | 2007-10-24 | ソニー株式会社 | 環境認識装置及び方法、経路計画装置及び方法、並びにロボット装置 |
| US20100235608A1 (en) * | 2004-03-25 | 2010-09-16 | Aiseek Ltd. | Method and apparatus for game physics concurrent computations |
| US7440447B2 (en) * | 2004-03-25 | 2008-10-21 | Aiseek Ltd. | Techniques for path finding and terrain analysis |
| KR100586994B1 (ko) * | 2004-09-07 | 2006-06-08 | 삼성전자주식회사 | 로봇제어장치 및 그 제어방법 |
| KR100664681B1 (ko) * | 2005-08-30 | 2007-01-04 | 주식회사 로보스타 | 매개변수곡선으로 기술된 로봇 경로의 샘플 테이터를이용한 직접보간 시스템 및 방법 |
| KR100722857B1 (ko) | 2006-01-12 | 2007-05-30 | 삼성전자주식회사 | 속도프로파일생성장치 및 그 제어방법 |
| KR100838974B1 (ko) * | 2006-12-14 | 2008-06-17 | 엘에스산전 주식회사 | 네트워크형 위치결정모듈의 다축 연속운전 속도 제어 방법 |
| US20080320068A1 (en) * | 2007-02-12 | 2008-12-25 | Bowling David G | Wideband suppression of motion-induced vibration |
| US7919940B2 (en) * | 2007-10-21 | 2011-04-05 | Ge Intelligent Platforms, Inc. | System and method for jerk limited trajectory planning for a path planner |
| CN102082545B (zh) * | 2009-11-27 | 2013-04-17 | 新代科技股份有限公司 | 马达速度控制器及其控制方法 |
| CN102328315B (zh) * | 2010-07-12 | 2014-01-01 | 深圳华强文化科技集团股份有限公司 | 一种机器人动作仿真的控制方法及装置 |
| KR101259819B1 (ko) * | 2010-12-24 | 2013-04-30 | 삼성중공업 주식회사 | 로봇의 연속 경로 제어 방법 및 이를 수행하는 로봇 시스템 |
| JP5908544B2 (ja) | 2014-08-11 | 2016-04-26 | ファナック株式会社 | 駆動軸のジャークを低下させるロボットプログラムを生成するロボットプログラム生成装置 |
| DE102017011334A1 (de) * | 2017-12-08 | 2019-06-13 | Kuka Deutschland Gmbh | Abfahren einer vorgegebenen Arbeitsbahn mit einem Roboter |
| CN108942939A (zh) * | 2018-07-31 | 2018-12-07 | 深圳市山龙智控有限公司 | 基于滑动滤波的scara机器人速度规划方法及其系统 |
| CN113664808B (zh) * | 2021-09-03 | 2023-03-14 | 苏州艾利特机器人有限公司 | 机器人运动控制方法、装置及存储介质 |
| CN114200892A (zh) * | 2021-11-01 | 2022-03-18 | 苏州谋迅智能科技有限公司 | 交互输入设备平滑输出的方法和装置、存储介质和设备 |
| CN114237161B (zh) * | 2021-11-16 | 2023-07-21 | 华南理工大学 | 一种基于数字滤波的工业机器人nurbs曲线插补方法 |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US3757095A (en) * | 1970-08-26 | 1973-09-04 | Tektronix Inc | Numerical control system |
| JPS59168513A (ja) * | 1983-03-16 | 1984-09-22 | Fanuc Ltd | 加減速制御方式 |
| EP0262600B1 (en) * | 1986-09-29 | 1992-11-25 | Asea Ab | Method and device for optimum parameter control of controllers for rotational and/or linear movements in one or more degrees of freedom in an industrial robot |
| EP0268491A3 (en) * | 1986-11-20 | 1988-08-03 | Unimation Inc. | Multiaxis robot having improved motion control |
| US4833399A (en) * | 1988-06-13 | 1989-05-23 | Texas Instruments Incorporated | DTMF receiver |
| JP2808119B2 (ja) * | 1988-07-28 | 1998-10-08 | ファナック株式会社 | 加減速制御方式 |
| US5331264A (en) * | 1993-04-15 | 1994-07-19 | Fanuc Robotics North America, Inc. | Method and device for generating an input command for a motion control system |
| US5434489A (en) * | 1993-07-30 | 1995-07-18 | Fanuc Robotics North America, Inc. | Method and system for path planning in cartesian space |
| JPH0991887A (ja) * | 1995-09-21 | 1997-04-04 | Sony Corp | ディジタル信号処理方法及び装置 |
-
1997
- 1997-12-31 KR KR1019970080191A patent/KR100242447B1/ko not_active IP Right Cessation
-
1998
- 1998-12-23 US US09/219,816 patent/US6046564A/en not_active Expired - Lifetime
- 1998-12-24 JP JP36813498A patent/JP4302805B2/ja not_active Expired - Fee Related
- 1998-12-30 CN CN98111660A patent/CN1064577C/zh not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| CN1230478A (zh) | 1999-10-06 |
| KR100242447B1 (ko) | 2000-04-01 |
| US6046564A (en) | 2000-04-04 |
| KR19990059974A (ko) | 1999-07-26 |
| CN1064577C (zh) | 2001-04-18 |
| JPH11249724A (ja) | 1999-09-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4302805B2 (ja) | ロボット制御のための経路計画装置及び経路計画方法 | |
| US6351740B1 (en) | Method and system for training dynamic nonlinear adaptive filters which have embedded memory | |
| JP3196390B2 (ja) | パラメータ同定器 | |
| JP2002062906A (ja) | 予測制御装置 | |
| WO1996004708A1 (fr) | Dispositif de commande de la vitesse d'un moteur | |
| JP2960086B2 (ja) | 最小２乗平均アルゴリズムを実施するためのパイプライン式プロセッサ | |
| JP2771929B2 (ja) | ディジタル・サーボ制御システム | |
| JP2007140950A (ja) | ディジタルサーボ制御装置 | |
| JP3955217B2 (ja) | 産業用ロボットの制御方法及び制御装置 | |
| JP6496167B2 (ja) | タンデム位置制御装置 | |
| JP2567158B2 (ja) | 制御装置 | |
| JPS63197202A (ja) | 動力サーボシステム | |
| US6611122B2 (en) | Method of control and control structure for the movement control, pre-control and fine interpolation of objects in a speed controller clock which is faster than the position controller clock | |
| EP0413030A1 (en) | Servo control method by the disturbance estimation observer | |
| JP2655904B2 (ja) | 適応制御装置 | |
| JP2722286B2 (ja) | サーボモータの最適加減速制御方式 | |
| JP3513633B2 (ja) | 未知連続時間システムの同定方法及び装置と、同装置を用いた制御システム | |
| JP3513989B2 (ja) | 位置決め制御系の指令補間方法 | |
| Sha Sadeghi et al. | A new impedance and robust adaptive inverse control approach for a teleoperation system with varying time delay | |
| JPH0557644A (ja) | ロボツトの制御方法 | |
| JP3870767B2 (ja) | 予測制御方法 | |
| JP2000330607A (ja) | むだ時間を有する制御系の制御装置 | |
| JP2867786B2 (ja) | 初期値設定方式 | |
| JP3782007B2 (ja) | ロータリカッタ制御装置 | |
| JP2569597B2 (ja) | 加減速制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20051027 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081007 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090105 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20090324 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090423 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120501 Year of fee payment: 3 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130501 Year of fee payment: 4 |
|
| LAPS | Cancellation because of no payment of annual fees |