JPH087625B2 - フィードフォワード補償を用いた位置制御装置 - Google Patents
フィードフォワード補償を用いた位置制御装置Info
- Publication number
- JPH087625B2 JPH087625B2 JP1175330A JP17533089A JPH087625B2 JP H087625 B2 JPH087625 B2 JP H087625B2 JP 1175330 A JP1175330 A JP 1175330A JP 17533089 A JP17533089 A JP 17533089A JP H087625 B2 JPH087625 B2 JP H087625B2
- Authority
- JP
- Japan
- Prior art keywords
- feedforward
- loop
- command
- gain
- axis
- 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 - Lifetime
Links
Landscapes
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Description
【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、NC装置，ロボットのように複数軸を有し、
各軸が位置制御を基本としているシステムにおいて、軌
跡指令に対する系の追従性を高めた位置制御装置に関す
る。
各軸が位置制御を基本としているシステムにおいて、軌
跡指令に対する系の追従性を高めた位置制御装置に関す
る。
NC,ロボットのように複数軸を有し、各軸が位置制御
を基本とするシステムにおいて、軌跡指令に系を追従さ
せる場合において、例えばＸ−Ｙテーブルで円弧を描か
せる場合（以下、説明の簡潔のため、Ｘ−Ｙテーブルを
例として説明する。）、位置制御系への指令は、次式で
表される。
を基本とするシステムにおいて、軌跡指令に系を追従さ
せる場合において、例えばＸ−Ｙテーブルで円弧を描か
せる場合（以下、説明の簡潔のため、Ｘ−Ｙテーブルを
例として説明する。）、位置制御系への指令は、次式で
表される。
ここで、Xref(t)はＸ軸への指令入力、Yref(t)はＹ軸
への指令入力、Rrefは指令半径、Rrspは応答半径、ωｏ
は指令角速度である。
への指令入力、Rrefは指令半径、Rrspは応答半径、ωｏ
は指令角速度である。
位置制御を第６図のような一次遅れ系であると考える
と、定常状態の応答は、次式で表される。
と、定常状態の応答は、次式で表される。
Xrsp（ｔ）＝Amsin（ωoｔ＋o） …（３） Yrsp（ｔ）＝Amcos（ωoｔ＋o） …（４） ただし、 したがって、応答半径は、 となって、要求されている半径の となってしまう。
（５）式の観察から分かるように、これを改善する方
法として、 １）位置ケープゲインKpを上げて（５）式の分母を小さ
くする（振幅特性を改善する）。
法として、 １）位置ケープゲインKpを上げて（５）式の分母を小さ
くする（振幅特性を改善する）。
２）指令角速度ωoを下げて（５）式の分母を小さくす
る。
る。
３）Rrspを要求される軌跡半径として指令半径Rrefを
（５）式から計算する。のいずれかの方法が採られてき
た。
（５）式から計算する。のいずれかの方法が採られてき
た。
２）の方法は、消極的な改善策で軌跡精度は上がる
が、描画速度は下がる。１）においては、位置ループゲ
インKpは、機構上の制約を受けており、通常は最適調整
されていて、改善を考える場合は固定で改善策とはなら
ない。
が、描画速度は下がる。１）においては、位置ループゲ
インKpは、機構上の制約を受けており、通常は最適調整
されていて、改善を考える場合は固定で改善策とはなら
ない。
３）の方法は、このうちで最もよく用いられている方
法で、制約は存在しない。しかし、円のような定形の図
形を描画する場合は、指令半径を前もって計算する程度
ですむが、任意形状の場合は、指令を系の動特性から、
前もって計算するのは多大な計算負荷を必要とする。
法で、制約は存在しない。しかし、円のような定形の図
形を描画する場合は、指令半径を前もって計算する程度
ですむが、任意形状の場合は、指令を系の動特性から、
前もって計算するのは多大な計算負荷を必要とする。
また、位置決めの場合において、位置指令は通常第８
図のようなランプ状指令が与えられるのであるが、第６
図の位置制御系においては、一巡伝達関係が「一形」で
あるので、定状速度偏差を生じる。
図のようなランプ状指令が与えられるのであるが、第６
図の位置制御系においては、一巡伝達関係が「一形」で
あるので、定状速度偏差を生じる。
この制御系において、要求される範囲内に定常速度偏
差を収めるには、位置ループゲインKpを上げることによ
り調整できるが、減速機の剛性等の機構的制約が存在す
るので、Kpを上げることに限界がある。
差を収めるには、位置ループゲインKpを上げることによ
り調整できるが、減速機の剛性等の機構的制約が存在す
るので、Kpを上げることに限界がある。
軌跡指令に追従させる場合においても、位置決めにお
いても、速度フィードフォワード補償を加えることが性
能向上に有効である。
いても、速度フィードフォワード補償を加えることが性
能向上に有効である。
軌跡制御の場合、任意形状の軌跡制御の軌跡精度を高
速性を損なうことなしに上げることに対して特に有効で
ある。
速性を損なうことなしに上げることに対して特に有効で
ある。
第７図において、KFはフィードフォワードゲインで、
これに（１）、（２）式を入力すると、定常応答は、次
式で表される。
これに（１）、（２）式を入力すると、定常応答は、次
式で表される。
Xrsp（ｔ）＝Am′sin（ωoｔ＋o＋） …（７） Yrsp（ｔ）＝Am′cos（ωoｔ＋o＋） …（８） ただし、 そこでフィードフォワードゲインKFを１とすると、Am
＝Rrefかつoかつo＋＝０となり、完全に指令に追
従する。
＝Rrefかつoかつo＋＝０となり、完全に指令に追
従する。
ところが、現実には、KF＝１とすることは、機構上の
制約から不可能で、ロボットのような剛性の低いシステ
ムにおいては、KFは大きくとれない。
制約から不可能で、ロボットのような剛性の低いシステ
ムにおいては、KFは大きくとれない。
位置決め制御の場合、速度フィードフォワード補償を
加えると、定常速度偏差が減少するので有効である。
加えると、定常速度偏差が減少するので有効である。
このことを以下に示すと、前記の第６図の制御系にお
いて、第８図のようなランプ入力を加えた場合の定常速
度偏差及び位置決め時の初期偏差は、速度をＡとする
と、共にA/KPとなる。これに対し、第７図の制御系のよ
うにフィードフォワードループを設けた場合には、第10
図に示すように、偏差を（A/KP）×（１−KF）と小さく
することができる（但し０＜KF＜１）。
いて、第８図のようなランプ入力を加えた場合の定常速
度偏差及び位置決め時の初期偏差は、速度をＡとする
と、共にA/KPとなる。これに対し、第７図の制御系のよ
うにフィードフォワードループを設けた場合には、第10
図に示すように、偏差を（A/KP）×（１−KF）と小さく
することができる（但し０＜KF＜１）。
いずれの場合も、位置ループゲインKPが固定の場合、
フィードフォワードループゲインKFを大きくとるか否か
が、高追従性（高軌跡性）と高速位置決めを決定する。
ところが、位置指令にランプ入力を加えた場合、補償ル
ープから速度指令にステップ状に補償信号が加わるの
で、フィードフォワードゲインKFを大きくとると、振動
等の問題を生じたり、機構系の寿命にも影響を与えたり
する。したがって、フィードフォワードゲインKFを思う
ように大きくとれないという問題があった。
フィードフォワードループゲインKFを大きくとるか否か
が、高追従性（高軌跡性）と高速位置決めを決定する。
ところが、位置指令にランプ入力を加えた場合、補償ル
ープから速度指令にステップ状に補償信号が加わるの
で、フィードフォワードゲインKFを大きくとると、振動
等の問題を生じたり、機構系の寿命にも影響を与えたり
する。したがって、フィードフォワードゲインKFを思う
ように大きくとれないという問題があった。
本発明は、このように速度フィードフォワード補償ル
ープを有するシステムにおいて、フィードフォワードゲ
インKFに限界がある場合に、軌跡精度の向上及び位置決
め時間短縮を図ることを目的とする。
ープを有するシステムにおいて、フィードフォワードゲ
インKFに限界がある場合に、軌跡精度の向上及び位置決
め時間短縮を図ることを目的とする。
この目的を達成するため、本発明のフィードフォワー
ド補償を用いた位置制御装置は、１軸又は複数軸を有
し、各軸が位置フィードバック制御によって制御される
位置制御装置において、位置フィードバックループに加
えて、位置指令を入力側とし、フィードフォワードゲイ
ンを有する微分要素とむだ時間要素又は一次遅れ要素を
直列に有し、前述位置フィードバックループの位置ルー
プゲインの後段に速度フィードフォワード補償出力が加
算されるフィードフォワードループを設けたことを特徴
とする。
ド補償を用いた位置制御装置は、１軸又は複数軸を有
し、各軸が位置フィードバック制御によって制御される
位置制御装置において、位置フィードバックループに加
えて、位置指令を入力側とし、フィードフォワードゲイ
ンを有する微分要素とむだ時間要素又は一次遅れ要素を
直列に有し、前述位置フィードバックループの位置ルー
プゲインの後段に速度フィードフォワード補償出力が加
算されるフィードフォワードループを設けたことを特徴
とする。
特に、軌跡精度の向上には、むだ時間要素を設けるこ
とが効果があり、また位置決め時間短縮には、一定遅れ
要素を設けると効果がある。
とが効果があり、また位置決め時間短縮には、一定遅れ
要素を設けると効果がある。
本発明においては、軌跡精度向上のために第１図のよ
うにフィードフォワード補償ループにむだ時間要素e-Ls
を加え、位置決め時間短縮のためには、第４図のように
一次遅れ要素〔1/（TFＳ＋１）〕を加える。
うにフィードフォワード補償ループにむだ時間要素e-Ls
を加え、位置決め時間短縮のためには、第４図のように
一次遅れ要素〔1/（TFＳ＋１）〕を加える。
軌跡制御の場合において、第１図のようなフィードフ
ォワードループにむだ時間要素e-Lsを有するシステム
に、（１），（２）式の入力を加えると定常応答は、 Xrsp（ｔ）＝Amsin（ωｔ＋o） ＋(KF/KP)Amωcos（ω（ｔ−Ｌ）＋） …（９） Yrsp（ｔ）＝Amcos（ωｔ＋o） ＋(KF/KP)Amωsin（ω（ｔ−Ｌ）＋o） …（10） ここで、時間軸をｔ′＝ｔ−Ｌとして、 Xrsp（ｔ′）＝Amsin（ω（ｔ′＋Ｌ）＋o） ＋(KF/KP)Amωcos（ωｔ′＋） Yrsp（ｔ′）＝Amcos（ω（ｔ′＋Ｌ）＋o） −(KF/KP)Amωsin（ωｔ′＋o） さらにまとめると、 Xrsp（ｔ′）＝AmcosωＬ・sin（ωｔ′＋o） ＋AmsinωＬ・cos（ωｔ′＋o） ＋(KF/KP)Amωcos（ωｔ′＋o） Yrsp（ｔ′）＝AmcosωＬ・cos（ωｔ′＋o） −AmsinωＬ・sin（ωｔ′＋o） −(KF/KP)Amωsin（ωｔ′＋o） ここで、軌跡制御の場合、描画速度は遅いので、ωＬ
は１に対して微小であると見なせるため、cosωＬ≒1,s
inωＬ≒ωＬと近似して、 Xrsp（ｔ′）＝Amsin（ωｔ′＋o） ＋AmωＬ・cos（ωｔ′＋o） ＋(KF/KP)Amωcos（ωｔ′＋o） Yrsp（ｔ′）＝Amcos（ωｔ′＋o） −AmωＬ・sin（ωｔ′＋o） −(KF/KP)Amωsin（ωｔ′＋o） さらに、 したがって、 Xrsp（ｔ′）＝Am″sin（ωoｔ′＋o＋′） …（1
1） Yrsp（ｔ′）＝Am″cos（ωoｔ′＋o＋′） …（1
2） ここで、 上式より、時間軸をｔ′＝ｔ−Ｌとすることで、等価
的にフィードフォワードゲインがＬ×KPだけ上昇したと
見なすことができる。
ォワードループにむだ時間要素e-Lsを有するシステム
に、（１），（２）式の入力を加えると定常応答は、 Xrsp（ｔ）＝Amsin（ωｔ＋o） ＋(KF/KP)Amωcos（ω（ｔ−Ｌ）＋） …（９） Yrsp（ｔ）＝Amcos（ωｔ＋o） ＋(KF/KP)Amωsin（ω（ｔ−Ｌ）＋o） …（10） ここで、時間軸をｔ′＝ｔ−Ｌとして、 Xrsp（ｔ′）＝Amsin（ω（ｔ′＋Ｌ）＋o） ＋(KF/KP)Amωcos（ωｔ′＋） Yrsp（ｔ′）＝Amcos（ω（ｔ′＋Ｌ）＋o） −(KF/KP)Amωsin（ωｔ′＋o） さらにまとめると、 Xrsp（ｔ′）＝AmcosωＬ・sin（ωｔ′＋o） ＋AmsinωＬ・cos（ωｔ′＋o） ＋(KF/KP)Amωcos（ωｔ′＋o） Yrsp（ｔ′）＝AmcosωＬ・cos（ωｔ′＋o） −AmsinωＬ・sin（ωｔ′＋o） −(KF/KP)Amωsin（ωｔ′＋o） ここで、軌跡制御の場合、描画速度は遅いので、ωＬ
は１に対して微小であると見なせるため、cosωＬ≒1,s
inωＬ≒ωＬと近似して、 Xrsp（ｔ′）＝Amsin（ωｔ′＋o） ＋AmωＬ・cos（ωｔ′＋o） ＋(KF/KP)Amωcos（ωｔ′＋o） Yrsp（ｔ′）＝Amcos（ωｔ′＋o） −AmωＬ・sin（ωｔ′＋o） −(KF/KP)Amωsin（ωｔ′＋o） さらに、 したがって、 Xrsp（ｔ′）＝Am″sin（ωoｔ′＋o＋′） …（1
1） Yrsp（ｔ′）＝Am″cos（ωoｔ′＋o＋′） …（1
2） ここで、 上式より、時間軸をｔ′＝ｔ−Ｌとすることで、等価
的にフィードフォワードゲインがＬ×KPだけ上昇したと
見なすことができる。
フィードフォワードゲインKFが与えられた場合、Ｌ＝
（１−KF）／KF）とすることで、等価的にフィードフォ
ワードゲインKF′を１にすることができ、Ｘ軸,Y軸とも
指令入力に対して時間Ｌだけ遅れて、指令入力と同じ波
形で追従させることができる。このことは、円を描かせ
た場合、時間Ｌの分、すなわち、Ｌ×ωoの角度分だけ
遅れて、軌跡に対して完全に追従することを意味する
（第２図参照）。
（１−KF）／KF）とすることで、等価的にフィードフォ
ワードゲインKF′を１にすることができ、Ｘ軸,Y軸とも
指令入力に対して時間Ｌだけ遅れて、指令入力と同じ波
形で追従させることができる。このことは、円を描かせ
た場合、時間Ｌの分、すなわち、Ｌ×ωoの角度分だけ
遅れて、軌跡に対して完全に追従することを意味する
（第２図参照）。
位置決め制御の場合において、一次遅れ要素をフィー
ドフォワードループに加えることは、次の２点で、位置
決め時間短縮につながっている。その第１点は、一次遅
れ要素を加えることにより、位置指令にランプ入力が加
わった場合、速度フィードフォワード補償がステップ状
に加わるのではなく、指数的に滑らかに補償信号が加わ
ることにより、振動を解消し、フィードフォワードゲイ
ンそのものを上げる可能性が大きくなる。
ドフォワードループに加えることは、次の２点で、位置
決め時間短縮につながっている。その第１点は、一次遅
れ要素を加えることにより、位置指令にランプ入力が加
わった場合、速度フィードフォワード補償がステップ状
に加わるのではなく、指数的に滑らかに補償信号が加わ
ることにより、振動を解消し、フィードフォワードゲイ
ンそのものを上げる可能性が大きくなる。
第２点は、ゲインKFを上げることができなくても、指
令がランプ状からフラットへと変わる時点（指令位置決
め時点）以降において、一次遅れ要素がない場合は、フ
ィードフォワード補償信号は、即時０となるが、一次遅
れ要素を有する場合、補償信号は、指数関係状に残留す
る。これが位置決め時間短縮に寄与する。このことを以
下に説明する。
令がランプ状からフラットへと変わる時点（指令位置決
め時点）以降において、一次遅れ要素がない場合は、フ
ィードフォワード補償信号は、即時０となるが、一次遅
れ要素を有する場合、補償信号は、指数関係状に残留す
る。これが位置決め時間短縮に寄与する。このことを以
下に説明する。
第10図は一次遅れ要素がない場合の速度フィードフォ
ワード補償を有する制御系の応答であり、ランプ入力が
無くなってからt2の時間で位置偏差が０になっている
が、本発明の一次遅れ要素を加えることにより、補償信
号が残留するため、第11図のように、t2よりも短い時間
t1の時間で位置偏差が０になっている。
ワード補償を有する制御系の応答であり、ランプ入力が
無くなってからt2の時間で位置偏差が０になっている
が、本発明の一次遅れ要素を加えることにより、補償信
号が残留するため、第11図のように、t2よりも短い時間
t1の時間で位置偏差が０になっている。
このことを説明すると、第12図のような傾きＶのラン
プ指令が入力されたとき、位置決め時の応答は、フィー
ドフォワードループに一次遅れ要素がない場合、偏差は となって、第13図のように位置決め時刻以降は、フィー
ドフォワードループは何ら寄与しない。
プ指令が入力されたとき、位置決め時の応答は、フィー
ドフォワードループに一次遅れ要素がない場合、偏差は となって、第13図のように位置決め時刻以降は、フィー
ドフォワードループは何ら寄与しない。
一次遅れ要素を有する場合、偏差は、 ｅ＝eDLY＝efree+eff となる。この式中、effが第14図の補償信号の残留分ef
に対する応答であり、 ただし、1/Tf＞KP である。この成分が、位置決め時間の短縮に寄与してい
る（第15図参照）。
に対する応答であり、 ただし、1/Tf＞KP である。この成分が、位置決め時間の短縮に寄与してい
る（第15図参照）。
なお、むだ時間要素を含むフィードフォワードループ
を設けた前述の実施例で説明したむだ時間Ｌの決め方、
すなわち、 Ｌ＝（１−KF)/KP とする発想を流用し、 TF＝（１−KF)/KP となるよう、一次遅れ時定数TFを設定してよいことは勿
論である。
を設けた前述の実施例で説明したむだ時間Ｌの決め方、
すなわち、 Ｌ＝（１−KF)/KP とする発想を流用し、 TF＝（１−KF)/KP となるよう、一次遅れ時定数TFを設定してよいことは勿
論である。
以下、本発明を実施例に基づいて具体的に説明する。
第３図は、第１図に示した制御系を備えた本発明の実
施例のサーボ装置の構成を示すものである。位置コント
ロール部は、位置ループ制御部１とフィードフォワード
補償部からなる。位置ループ制御部１とフィードフォワ
ード補償部からなる。位置ループ制御部は上位からの位
置指令とパルス発生器８からの位置フィードバック値の
偏差に位置ゲインを乗じた信号を出力する。フィードフ
ォワード補償部は、幾分処理２、ゲイン部３及びむだ時
間要素４とからなる。
施例のサーボ装置の構成を示すものである。位置コント
ロール部は、位置ループ制御部１とフィードフォワード
補償部からなる。位置ループ制御部１とフィードフォワ
ード補償部からなる。位置ループ制御部は上位からの位
置指令とパルス発生器８からの位置フィードバック値の
偏差に位置ゲインを乗じた信号を出力する。フィードフ
ォワード補償部は、幾分処理２、ゲイン部３及びむだ時
間要素４とからなる。
位置ループ制御部とフィードフォワード補償部の出力
信号は、加算されて、D/A変換器５に入力され、D/A変換
器５は、変換した信号を速度指令として速度制御ユニッ
ト６に入力する。速度制御ユニットは、速度指令，パル
ス発生器８からの位置フィードバック値の幾分値、及び
モータ７からの電流フィードバック値からモータ７への
出力電圧を決定する。
信号は、加算されて、D/A変換器５に入力され、D/A変換
器５は、変換した信号を速度指令として速度制御ユニッ
ト６に入力する。速度制御ユニットは、速度指令，パル
ス発生器８からの位置フィードバック値の幾分値、及び
モータ７からの電流フィードバック値からモータ７への
出力電圧を決定する。
本発明は、フィードフォワード補償部にむだ時間要素
４を加えることで、等価なフィードフォワードゲインを
増加することを可能にした。
４を加えることで、等価なフィードフォワードゲインを
増加することを可能にした。
第５図は、第４図の制御系を備えた本発明の他の実施
例の構成を示すものである。第３図の実施例と異なると
ころは、むだ時間要素４に代えてディジタル一次遅れフ
ィルタ９を設けたことにある。この場合、ディジタル一
次遅れフィルタ９の時定数TFを、制御系における機械系
の共振同波数近傍に設定することにより、振動防止効果
を上げることができる。このように、フィードフォワー
ド補償部にディジタル一次遅れフィルタ９を加えること
により、振動を防止することができ、ひいてはゲイン部
３の定数を上げることが可能となる。
例の構成を示すものである。第３図の実施例と異なると
ころは、むだ時間要素４に代えてディジタル一次遅れフ
ィルタ９を設けたことにある。この場合、ディジタル一
次遅れフィルタ９の時定数TFを、制御系における機械系
の共振同波数近傍に設定することにより、振動防止効果
を上げることができる。このように、フィードフォワー
ド補償部にディジタル一次遅れフィルタ９を加えること
により、振動を防止することができ、ひいてはゲイン部
３の定数を上げることが可能となる。
以上に説明したように、本発明においては、速度指令
部にむだ時間要素あるいは一次遅れ要素を含むフィード
フォワードループを設けている。むだ時間要素を設ける
ことにより、フィードフォワードゲインKFを上げること
なく、かつ、高速性を損なうことなく高軌跡精度を実現
することが可能となる。また、一次遅れ要素を設けるこ
とにより、フィードフォワードゲインKFを上げることが
でき、高追従性（高軌跡性）が増加し、位置決め時に補
償信号が残留することで、高速位置決めが可能となる。
部にむだ時間要素あるいは一次遅れ要素を含むフィード
フォワードループを設けている。むだ時間要素を設ける
ことにより、フィードフォワードゲインKFを上げること
なく、かつ、高速性を損なうことなく高軌跡精度を実現
することが可能となる。また、一次遅れ要素を設けるこ
とにより、フィードフォワードゲインKFを上げることが
でき、高追従性（高軌跡性）が増加し、位置決め時に補
償信号が残留することで、高速位置決めが可能となる。
第１図は本発明のむだ時間要素を含むフィードフォワー
ドループを有する制御系のブロック図、第２図は指令円
と応答円の関係を示す軌跡図、第３図は本発明のむだ時
間要素を含むフィードフォワードループを有する制御系
の実施例を示すブロック図、第４図は本発明の一次遅れ
要素を含むフィードフォワードループを有する制御系の
ブロック図、第５図はその実施例を示すブロック図、第
６図は一般的な位置フィードバックループを有する制御
系のブロック図、第７図はフィードフォワード補償を有
する制御系のブロック図、第８図はランプ入力の波形
図、第９図は第６図の制御系のランプ応答を示す波形
図、第10図は第７図の制御系のランプ応答を示す波形
図、第11図は本発明の一次遅れ要素を加えたときのラン
プ応答を示す波形図、第12図〜第15図は一次遅れ要素を
加えたことによる効果を示す説明図である。 1:位置ループ制御部、2:微分処理部、3:ゲイン部 4:むだ時間要素、5:D/A変換器、6:速度制御ユニット 7:モータ、8:位置検出器（パルスジェネレータ） 9:一次遅れ要素
ドループを有する制御系のブロック図、第２図は指令円
と応答円の関係を示す軌跡図、第３図は本発明のむだ時
間要素を含むフィードフォワードループを有する制御系
の実施例を示すブロック図、第４図は本発明の一次遅れ
要素を含むフィードフォワードループを有する制御系の
ブロック図、第５図はその実施例を示すブロック図、第
６図は一般的な位置フィードバックループを有する制御
系のブロック図、第７図はフィードフォワード補償を有
する制御系のブロック図、第８図はランプ入力の波形
図、第９図は第６図の制御系のランプ応答を示す波形
図、第10図は第７図の制御系のランプ応答を示す波形
図、第11図は本発明の一次遅れ要素を加えたときのラン
プ応答を示す波形図、第12図〜第15図は一次遅れ要素を
加えたことによる効果を示す説明図である。 1:位置ループ制御部、2:微分処理部、3:ゲイン部 4:むだ時間要素、5:D/A変換器、6:速度制御ユニット 7:モータ、8:位置検出器（パルスジェネレータ） 9:一次遅れ要素
───────────────────────────────────────────────────── フロントページの続き (72)発明者 川井 文明 福岡県北九州市小倉北区大手町12番１号 株式会社安川電機製作所小倉工場内 (56)参考文献 特開 昭64−26908（ＪＰ，Ａ) 特開 昭62−234501（ＪＰ，Ａ) 特開 昭58−165106（ＪＰ，Ａ) 特開 昭57−125402（ＪＰ，Ａ) 特開 昭63−100505（ＪＰ，Ａ) 特開 昭64−29901（ＪＰ，Ａ)
Claims (2)
- 【請求項１】１軸又は複数軸を有し、各軸が位置フィー
ドバック制御によって制御される位置制御装置におい
て、位置フィードバックループに加えて、位置指令を入
力側とし、フィードフォワードゲインを有する微分要素
とむだ時間要素を直列に有し、前記位置フィードバック
ループの位置ループゲインの後段に速度フィードフォワ
ード補償出力が加算されるフィードフォワードループを
設けたことを特徴とするフィードフォワード補償を用い
た位置制御装置。 - 【請求項２】１軸又は複数軸を有し、各軸が位置フィー
ドバック制御によって制御される位置制御装置におい
て、位置フィードバックループに加えて、位置指令を入
力側とし、フィードフォワードゲインを有する微分要素
と一次遅れ要素を直列に有し、前記位置フィードバック
ループの位置ループゲインの後段に速度フィードフォワ
ード補償出力が加算されるフィードフォワードループを
設けたことを特徴とするフィードフォワード補償を用い
た位置制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP1175330A JPH087625B2 (ja) | 1989-07-06 | 1989-07-06 | フィードフォワード補償を用いた位置制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP1175330A JPH087625B2 (ja) | 1989-07-06 | 1989-07-06 | フィードフォワード補償を用いた位置制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH0340008A JPH0340008A (ja) | 1991-02-20 |
| JPH087625B2 true JPH087625B2 (ja) | 1996-01-29 |
Family
ID=15994188
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP1175330A Expired - Lifetime JPH087625B2 (ja) | 1989-07-06 | 1989-07-06 | フィードフォワード補償を用いた位置制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPH087625B2 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2013180222A1 (ja) | 2012-05-30 | 2013-12-05 | 株式会社神戸製鋼所 | 多関節ロボットの軌跡制御装置および制御方法 |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6313591B1 (en) * | 2000-02-17 | 2001-11-06 | Siemens Aktiengesellschaft | Delay time modeling filter for cascaded regulator structure |
| JP4362762B2 (ja) * | 2003-10-29 | 2009-11-11 | 株式会社安川電機 | サーボ制御装置およびその調整方法 |
| JP4506561B2 (ja) * | 2005-05-25 | 2010-07-21 | ソニー株式会社 | 自動制御装置 |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS57125402A (en) * | 1981-01-29 | 1982-08-04 | Toshiba Corp | Feed forward controller |
| JPS58165106A (ja) * | 1982-03-26 | 1983-09-30 | Toshiba Corp | フイ−ドフオワ−ド制御装置 |
| JPS62234501A (ja) * | 1986-04-04 | 1987-10-14 | Ishikawajima Harima Heavy Ind Co Ltd | 濃縮装置の濃度制御装置 |
| JPS63100505A (ja) * | 1986-10-17 | 1988-05-02 | Mitsubishi Heavy Ind Ltd | 多自由度可動機械のフイ−ドフオワ−ド制御装置 |
| JPS6426908A (en) * | 1987-07-23 | 1989-01-30 | Nippon Kokan Kk | Control method for arc locus of biaxial feed drive mechanism |
| JPS6429901A (en) * | 1987-07-24 | 1989-01-31 | Sekisui Chemical Co Ltd | Pid controller |
-
1989
- 1989-07-06 JP JP1175330A patent/JPH087625B2/ja not_active Expired - Lifetime
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2013180222A1 (ja) | 2012-05-30 | 2013-12-05 | 株式会社神戸製鋼所 | 多関節ロボットの軌跡制御装置および制御方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| JPH0340008A (ja) | 1991-02-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JPH087625B2 (ja) | フィードフォワード補償を用いた位置制御装置 | |
| US5414620A (en) | Synthetic friction algorithm for a hand control element | |
| JPS5932012A (ja) | 位置決めサ−ボ方式 | |
| JPS61163406A (ja) | ロボツト制御装置 | |
| US6920362B2 (en) | Control apparatus | |
| JP2559107B2 (ja) | 位置制御方法 | |
| JP3068381B2 (ja) | サーボ制御装置 | |
| JPS61217802A (ja) | ロボツト制御装置 | |
| Erbatur et al. | Robust control of a direct drive manipulator | |
| JP2515549B2 (ja) | 多軸サ−ボ機構の円弧軌跡制御装置 | |
| CN115884852A (zh) | 控制装置、机器人控制装置以及控制方法 | |
| Cheah et al. | Discrete-time model reference learning control: Theory and experiment | |
| JP2563318B2 (ja) | 産業機械の位置制御装置 | |
| JP2595610B2 (ja) | 位置決め制御装置 | |
| JPH06339882A (ja) | 産業用ロボットの制御装置 | |
| Kotake | Two-step acceleration/deceleration for vibration-damped transfer of a 1DOF overhead traveling crane under open/closed-loop finite-time settling control using solutions of a two-point boundary value problem with half-odd-integer trigonometric functions | |
| JP2858696B2 (ja) | 予見制御方法 | |
| JPH0588749A (ja) | スライデイングモード制御方法 | |
| JPH06276774A (ja) | 電動機の位置決め制御方法 | |
| JP2653130B2 (ja) | 加減速制御装置 | |
| KR0165450B1 (ko) | 교류 서보 모터의 위치 제어기 | |
| JPH0231407B2 (ja) | Ichigimekikonoseigyohoshiki | |
| KR0183683B1 (ko) | 로봇의 위치제어 방법 및 장치 | |
| JPS6247705A (ja) | ロボツト制御方法 | |
| JPS6120105A (ja) | 産業用ロボツトの位置決め制御回路 |