JP3164580B2 - ディジタルサーボ制御装置 - Google Patents

ディジタルサーボ制御装置

Info

Publication number
JP3164580B2
JP3164580B2 JP25922990A JP25922990A JP3164580B2 JP 3164580 B2 JP3164580 B2 JP 3164580B2 JP 25922990 A JP25922990 A JP 25922990A JP 25922990 A JP25922990 A JP 25922990A JP 3164580 B2 JP3164580 B2 JP 3164580B2
Authority
JP
Japan
Prior art keywords
value
current
time
feedforward
feedback loop
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
Application number
JP25922990A
Other languages
English (en)
Other versions
JPH04135215A (ja
Inventor
孝夫 米田
友也 加藤
寿宏 米津
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.)
Toyoda Koki KK
Original Assignee
Toyoda Koki KK
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 Toyoda Koki KK filed Critical Toyoda Koki KK
Priority to JP25922990A priority Critical patent/JP3164580B2/ja
Priority to US07/764,825 priority patent/US5313147A/en
Priority to EP91116448A priority patent/EP0479136A1/en
Publication of JPH04135215A publication Critical patent/JPH04135215A/ja
Application granted granted Critical
Publication of JP3164580B2 publication Critical patent/JP3164580B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/19Numerical 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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/33Director till display
    • G05B2219/33224Several serial channels, each provided with d-a to terminals of servomotor
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/34Director, elements to supervisory
    • G05B2219/34047Dsp digital signal processor
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41319Ac, induction motor
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41427Feedforward of position
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41429Mean value of previous feedforward values
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41431Delay position command as function of calculation time for feedforward, or order of system
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/42Servomotor, servo controller kind till VSS
    • G05B2219/42034Pi regulator
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/42Servomotor, servo controller kind till VSS
    • G05B2219/42062Position and speed and current

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position Or Direction (AREA)
  • Control Of Electric Motors In General (AREA)
  • Feedback Control In General (AREA)
  • Control Of Ac Motors In General (AREA)

Description

【発明の詳細な説明】 【産業上の利用分野】
本発明は、フィードフォワード機能を有するディジタ
ルサーボ制御装置に関する。
【従来技術】
従来、サーボ制御装置において、アナログ式のフィー
ドフォワード機能を有するものが知られている。 このアナログ式のフィードフォワードは、指令パルス
の周波数を電圧に変換して速度フィードバックループに
加算出力するものである。
【発明が解決しようとする課題】
このアナログ式のフィードフォワード機能を有するも
のにおいては、フィードフォワード値がそのF/V変換時
にハードウェアのもつ時定数により所定の時間だけ遅れ
が発生する。 上述の時間ズレ(位相ズレ)が存在すると、指令速度
が不必要に変化することとなる。その結果、サーボ系が
振動して、工作物の加工面にビビリが発生し、工作物の
仕上げ形状を変形させる原因となっていた。 本発明は、上記の課題を解決するために成されたもの
であり、その目的とするところは、サーボ系の振動によ
って生じる工作物の加工面のビビリをなくし、工作物の
加工形状の精度を向上させることである。
【課題を解決するための手段】
上記課題を解決するための発明の構成は、位置フィー
ドバックループ、速度フィードバックループ、電流フィ
ードバックループを有し、指令値及び帰還値をディジタ
ル量で与えたディジタルサーボ制御装置において、現在
時刻において指令された目標位置の時間変動から算出さ
れた指令速度に対応した現在時刻のフィードフォワード
値を算出するフィードフォワード値演算手段と、フィー
ドフォワード値演算手段により過去所定時間内に算出さ
れたフィードフォワード値を記憶する記憶手段と、記憶
手段に記憶されたフィードフォワード値の平均値を現在
時刻より所定の遅延時間だけ遅延した時刻におけるフィ
ードフォワード値として速度フィードバックループに加
算出力するフィードフォワード出力手段と、所定の遅延
時間だけ前記目標位置の出力を遅延させて位置フィード
バックループに出力する目標位置遅延手段とを備えたこ
とを特徴とする。
【作用】
フィードフォワード値演算手段により現在時刻におい
て指令された目標位置の時間変動から算出された指定速
度に対応した現在時刻のフィードフォワード値が算出さ
れる。 又、記憶手段には、過去所定時間内に算出されたフィ
ードフォワード値が記憶される。そして、フィードフォ
ワード出力手段により、記憶手段に記憶された現在時刻
までの過去一定期間内の値の平均値が所定の遅延時間だ
け遅延した時刻におけるフィードフォワード値として、
速度フィードバックループに加算出力される。 即ち、算出されたフィードフォワード値が過去所定時
間内に大きく変動するような場合にも、平均値が求めら
れてスムージングされるので、結果的にフィードフォワ
ード値の変化率を小さくすることができる。 又、フィードフォワード出力手段は、現在時刻で演算
された平均値を所定の遅延時間だけ遅延した時刻におけ
るフィードバック値として出力するため、目標位置遅延
手段も、所定の遅延時間だけ目標位置の出力が遅延され
て上記位置フィードバックループに出力される。 即ち、フィードフォワード制御に際して、そのフィー
ドフォワード値が安定して与えられると共に同期が図ら
れるので、サーボ系の振動が抑えられる。
【実施例】
以下、本発明を具体的な実施例に基づいて説明する。 第1図は本発明に係るディジタルサーボ制御装置の構
成を示したブロックダイヤグラムである。 ディジタルサーボ制御装置10は主として、CPU11、ROM
12、RAM13、ディジタルシグナルプロセッサ(以下「DS
P」という)14、共通RAM17,A/D変換器15a,15b及び現在
値カウンタ16から構成されている。CPU11にはインタフ
ェース19を介してキーボード21及びCRT表示装置22が接
続されている。 DSP14の出力はインバータ25に入力され、そのインバ
ータ25はDSP14の出力信号に応じてサーボモータ31を駆
動する。サーボモータ31には同期モータが用いられ、イ
ンバータ25のPWM電圧制御によりサーボモータ31の負荷
電流が制御され、その結果、出力トルクが制御される。 サーボモータ31のu相及びv相の負荷電流はCT32a,32
bにより検出され、増幅器18a,18bにより増幅される。そ
の増幅器18a,18bの出力は、A/D変換器15a,15bに入力さ
れ、所定の周期でサンプリングされ、ディジタル値に変
換される。そのサンプリングされた値は、瞬時負荷電流
のフィードバック値として、DSP14に入力する。 又、サーボモータ31にはパルスエンコーダ33が接続さ
れ、その現在位置が検出される。パルスエンコーダ33の
出力は波形成形・方向判別回路34を介して現在値カウン
タ16に接続されている。 波形成形・方向判別回路34を介して現在値カウンタ16
に入力されるパルスエンコーダ33からの出力信号は現在
値カウンタ16の値を加減させる、DSP14により、現在値
カウンタ16の値は現在位置フィードバック値として読み
込まれ、DSP14により、CPU11から出力された目標値と比
較され位置偏差が算出される。そして、DSP14により、
その位置偏差に基づいて速度目標値が算出される。 又、DSP14に入力された現在位置フィードバック値は
微分され、速度フィードバック値が算出される。DSP14
により、位置偏差に応じて決定される速度目標値と速度
フィードバック値とが比較され速度偏差が算出され、そ
の速度偏差に基づいて電流目標値が算出される。 DSP14により、この電流目標値は、増幅器18a,18b及び
A/D変換器15a,15bを介してCT32a,32bにて検出された負
荷電流の電流フィードバック値と比較され、電流偏差が
算出される。その時の瞬時電流偏差と瞬時電流偏差の累
積値と電流目標値とに基づいて、即ち、比例積分演算に
より、その時の瞬時電流指令値が演算される。その瞬時
電流指令値は高周波数の三角波と比較され、インバータ
25の各相のトランジスタのオンオフを制御する電圧制御
PWM信号が生成される。その電圧制御PWM信号は、インバ
ータ25に出力され、そのインバータ25の各相のトランジ
スタがそれぞれ駆動される。このインバータ25のスイッ
チングにより、各相の負荷電流は電流目標値に制御され
ることになる。 尚、サーボモータ31の位置決めは、CPU11により、現
在値カウンタ16の出力値が位置の目標値に等しくなった
と判定された時に完了される。 又、A/D変換器15a,15bによってサンプリングされたu
相、v相の負荷電流値は、DSP14によりdq変換される。 本実施例のディジタルサーボ制御装置は、上述したよ
うに、位置、速度及び電流の3つのフィードバックルー
プにより構成されている。より下位のフィードバックル
ープ程、より高い応答性が要求され、例えば、最下位の
電流フィードバックループは100μs、速度フィードバ
ックループはその数倍、位置フィードバックループは更
にその数倍の時間間隔で同期をとってデータのサンプリ
ングが実行され、それぞれのフィードバックループの処
理が実行される。 第2図は、上述された本実施例装置の位置、速度及び
電流の3つのフィードバックループに対するフィードフ
ォワード制御の概念を示したブロックダイヤグラムであ
る。 現在時刻(i+t/2)において、指令された目標位置
(fi+t/2)は、フィードフォワードループで微分器
Sにより微分され、フィードフォワードゲインKにより
現在時刻における速度目標値のフィードフォワード値
(K・fi+t/2・S)が演算される。そして、それら
の値は過去一定時間t内のデータのみ保存される。 次に、過去の所定時間内、即ち、(i−t/2)時刻か
ら(i+t/2)時刻までの時間tにおいて記憶されたフ
ィードフォワード値(Kf・S)は、スムージング処理さ
れて、フィードフォワード値(K′f・S)となる。 そして、所定の遅延時刻(i−Δt)におけるスムー
ジング処理されたフィードフォワード値(K′f
i−Δt・S)が速度フィードバックループの指令値に
加算される。尚、Δtは位置フィードバックループにお
ける帰還データの遅延時間である。 一方、現在時刻(i+t/2)における指令された目標
位置(fi+t/2)は、時間遅れ補償により{(−t/2)
−Δt}時間だけ前の目標位置(fi−Δt)が位置フ
ィードバックループの指令値として出力される。 尚、Kpは位置フィードバックループゲインである。 このようにして、速度フィードバックループにおける
フィードフォワード値と速度指令値とにおける位相ズレ
がなくなる。 次に、本実施例装置の作動について説明する。 第3図のプログラムは、DSP14によって、所定の最小
周期毎に繰り返し実行される。 ステップ100では、現実行サイクルが位置偏差演算タ
イミングか否かが判定され、位置偏差演算タンミングで
あればステップ102に移行し、共通RAMからCPU11により
指令された目標位置P0が入力され記憶される。又、過去
一定時間t内の目標位置は共通RAM17に記憶されてい
る。 次に、フィードフォワード値演算手段を達成するステ
ップ104に移行し、ステップ102で記憶された目標位置P0
を微分演算し、フィードフォワード値を演算する。過去
一定時間t内のこれらの値は共通RAM17に保存され、新
しいフィードフォワード値が生成される毎に最も古いフ
ィードフォワード値は捨てられる。 次に、スムージング手段を達成するステップ106に移
行し、スムージング処理としてステップ104で算出され
たフィードフォワード値の所定の時間tにおける平均値
dPが算出される。そのdPが時刻i(時間tの中央時刻)
におけるスムージングされたフィードフォワード値とさ
れる。一定時間t内のこれらの値はRAM17に保存され
る。 次にステップ108に移行して、現在値カウンタ16に保
持された位置の現在値Paが読み込まれる。 次に、ステップ110において、現在時刻(i+t/2)か
ら{(t/2)−Δt}遅延された(i−Δt)時刻の目
標位置P(i−Δt)と現在位置Paとの位置偏差ΔP
(i−Δt)が演算される。この値は、共通RAM17のP
(i),P(i−1)の値をΔtで補間して求められる。 次に、ステップ12において、速度目標値が位置偏差Δ
P(i−Δt)に比例した値、即ち、次式により演算さ
れる。 V=kP・Δp(i−Δt) この位置のフィードバック制御は、第4図の信号S1で
示したタイミングで実行される。 次に、ステップ114において、現実行サイクルが速度
偏差演算タイミングか否かが判定される。 速度偏差演算タンミングであればステップ116に移行
し、現在値カウンタ16に保持された位置の現在値(電気
角)θ(n)が読み込まれる。 次にステップ118に移行して、時刻(i−Δt)にお
けるスムージングされたフィードフォワード値が共通RA
M17から読み出されて、フィードフォワード制御による
速度目標値が次式により演算され更新される。 V=V+dP(i−Δt) 次に、ステップ120において、前回の速度偏差演算タ
イミング時に読み込まれた位置の現在値(電気角)θ
(n−1)と、速度制御周期Dとから現速度制御期間に
おける速度の現在値V(n)が次式によって演算され
る。 v(n)=(θ(n)−θ(n−1))/D …(1) 又、ステップ112で設定された速度目標値に対する偏
差、即ち、速度偏差が演算される。 そして、次のステップ122において、その速度偏差に
応じて、d軸成分とq軸成分の電流目標値が演算され
る。この速度フィードバック制御は、第4図の信号S2で
示したタイミングで実行される。 次に、ステップ124において、現実行サイクルが電流
偏差演算タイミングか否かが判定される。 電流偏差演算タイミングであれば、ステップ126に移
行する。 ステップ126以下は電流フィードバック制御であり、
この制御は、第4図の信号S3に示したタイミングで実行
される。 ステップ126は、電流制御期間の先頭から測定した次
のステップ128での電流検出時刻Δt1と、電流制御期間
の先頭から測定した負荷電流の制御時刻Δt2を用いて、
その時刻に対応した電気角である電流検出時電気θ
制御時電気角度θが補間演算される。 θ=θ(n)+ΔV(n)・Δt1 …(2) θ=θ(n)+ΔV(n)・Δt2 …(3) この時刻Δt1,Δt2と電気角θ1とは第4図に示
したように対応している。 次にステップ128に移行して、u相、v相の瞬時負荷
電流の現在値Iu,IvがA/D変換器15a,15bから読み込まれ
る。 次に、ステップ130において、その電流の現在値Iu,Iv
はdq変換されて、d軸成分Idとq軸成分Iqとが次式によ
って演算される。 尚、dq座標系は、良く知られたように、d軸は励磁磁
場と同相にとられ、q軸は励磁磁場と電気角で90゜の位
相差にとられた座標系である。d軸成分は無効成分をq
軸成分は有効成分を表す。 次に、ステップ132において、ステップ122で設定され
たd軸成分とq軸成分の電流目標値を基準として、比較
積分演算により、現時点でのd軸成分とq軸成分の電流
指令値Id,Iqが演算される。 次に、ステップ134において、次式により、電流指令
値Id,Iqを逆dq変換して、各相電流指令値Iu,I
v,Iwが演算される。 尚、Iwは、Iw=−(Iu+Iv)によって演算さ
れる。 次に、ステップ136,138において、各相電流指令値Iu
,Iv,Iwと高周波数の三角波とのレベル関係を利用
して、即ち、平均電圧法を用いて、1つの制御周期内に
おける一連のPWM信号が生成される。 一連のPWM信号は、第5図に示したように、各相の電
圧印加状態を示した電圧ベクトルで表すことができる。
回転磁界ベクトルは、この電圧ベクトルの積分として表
される。 従って、第6図に示したように、各電圧ベクトル×継
続時間の和によって回転磁界ベクトルの先端の軌跡が描
かれる。回転磁界を角度2π/n毎に円周上の点に最短経
路で位置決めするためには、1制御周期毎に、第5図に
示した隣接する2つの電圧ベクトルと零ベクトルV0との
3つのベクトルでインバータ25が制御される必要があ
る。この3つの電圧ベクトルの組合せと回転磁界の位相
とは一意的に対応する。回転磁界の位相と電圧ベクトル
の組合せの対応表(零ベクトルV0は必ず組合せの1要素
となるので、2つの電圧ベクトルの組だけで良い)が、
第7図に示したように、予めROM12に記憶されている。 ステップ136では、制御時電気角θ(回転磁界の位
相)から、ROM12における上記のテーブルを検索してそ
の時の電圧ベクトルの組合せを求める。 ステップ138では、各電圧ベクトルの継続時間t1,t2,t
3が演算される。 例えば、その電圧ベクトルの組合せが、第8図に示し
たように、V6=(1,1,0),V1=(1,0,0),V0=(0,0,
0)となったとして、各電圧ベクトルの継続時間t1,t2,t
3が演算される。その演算方法は、本実施例では、良く
知られた平均電圧法が用いられている。 即ち、各相電流指令値Iu,Iv,Iwのうち、絶対値
の大きい2つを大きい順にI1 ,I2 とするとき、継続
時間t1,t2,t3は次式で求められる。 t1=|2I2 +I1 |・T/Vdc …(8) t2=|I1 −I2 |・T/Vdc …(9) t3=T−(t1+t2) …(10) 但し、Tは周期、Vdcは印加直流電圧である。 次に、ステップ140において、1組の電圧ベクトルに
よるPWM信号が、継続時間t1,t2,t3だけ出力される。例
えば、第8図に示したように、V6=(1,1,0),V1=(1,
0,0),V0=(0,0,0)の順に、継続時間t1,t2,t3だけ出
力される。又、換言すれば、U相はt1+t2だけ電圧が印
加され、V相はt1だけ電圧が印加され、W相にはその制
御期間、電圧は印加されない。 このようにして、1つの実行サイクルの処理が完了す
る。この実行サイクルは、最小の制御周期で実行されて
おり、その整数倍n1で電流フィードバックループが制御
され、その整数倍n2で速度フィードバックループが制御
され、その整数倍n3で位置フィードバックループが制御
されるように、ステップ100,114,124で判定の基準とな
る回数が設定されている。但し、n1<n2≦n3である。 上記のサイクルが繰り返し実行されることで、第4図
に示したタイミングで、位置、速度、電流のフィードバ
ック制御が行われる。 但し、第4図に示したタイミングはCPU11によるプロ
グラム実行時からの計時によって検出される。 このように、フィードフォワード値は予め所定時間に
て平均化されて安定した値となる。又、時間遅れ補償が
行われることにより、指令された目標位置と位置フィー
ドバックループの帰還値とフィードフォワード値とを同
期させることができる。
【発明の効果】
本発明は、平均演算によりスムージングされたフィー
ドフォワード値が目標位置と位置フィードバックループ
からの帰還値との出力値と同期するように目標位置又は
フィードフォワード値に対して時間遅れ補償して更新す
るようにしたものである。 つまり、フィードフォワード値はスムージングされ、
且つ、目標位置と位置フィードバックループからの帰還
値とフィードフォワード値との時間ズレがなくなってモ
ータに対する指令速度が不必要に変化することがない。 従って、本発明に係るフィードフォワード制御におい
ては、サーボ系の振動が抑えられ工作物の仕上げ形状が
良くなる。
【図面の簡単な説明】
第1図は本発明の具体的な一実施例に係るディジタルサ
ーボ制御装置の構成を示したブロックダイヤグラム。第
2図は同実施例装置の位置、速度及び電流の3つのフィ
ードバックループに対するフィードフォワード制御の概
念を示したブロックダイヤグラム。第3図は同実施例装
置で使用されているDSPによる処理手順を示したフロー
チャート。第4図は同じくDSPによる位置、速度、電流
フィードバック制御のタイミングを示したタイミングチ
ャート。第5図はPWM信号に対応した電圧ベクトルを示
したベクトル図。第6図は電圧ベクトルと回転磁界との
関係を示したベクトル図。第7図は回転磁界の位相と電
圧ベクトルとの組の対応関係を示した説明図。第8図は
PWM信号を示したタイミングチャートである。 10……ディジタルサーボ制御装置 11……CPU、12……ROM、13……RAM 14……DSP(ディジタルシグナルプロセッサ) 15a,15b……A/D変換器 16……現在値カウンタ 25……インバータ、31……サーボモータ 32a,32b……カレントトランスフォーマ(CT) 33……パルスエンコーダ
フロントページの続き (56)参考文献 特開 平1−191908(JP,A) (58)調査した分野(Int.Cl.7,DB名) G05D 3/12 305

Claims (1)

    (57)【特許請求の範囲】
  1. 【請求項1】位置フィードバックループ、速度フィード
    バックループ、電流フィードバックループを有し、指令
    値及び帰還値をディジタル量で与えたディジタルサーボ
    制御装置において、 現在時刻において指令された目標位置の時間変動から算
    出された指令速度に対応した現在時刻のフィードフォワ
    ード値を算出するフィードフォワード値演算手段と、 前記フィードフォワード値演算手段により過去所定時間
    内に算出されたフィードフォワード値を記憶する記憶手
    段と、 前記記憶手段に記憶されたフィードフォワード値の平均
    値を現在時刻より所定の遅延時間だけ遅延した時刻にお
    けるフィードフォワード値として前記速度フィードバッ
    クループに加算出力するフィードフォワード出力手段
    と、 前記所定の遅延時間だけ前記目標位置の出力を遅延させ
    て前記位置フィードバックループに出力する目標位置遅
    延手段と を備えたことを特徴とするディジタルサーボ制御装置。
JP25922990A 1990-09-27 1990-09-27 ディジタルサーボ制御装置 Expired - Fee Related JP3164580B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP25922990A JP3164580B2 (ja) 1990-09-27 1990-09-27 ディジタルサーボ制御装置
US07/764,825 US5313147A (en) 1990-09-27 1991-09-24 Digital servo-control apparatus
EP91116448A EP0479136A1 (en) 1990-09-27 1991-09-26 Digital servo-control apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP25922990A JP3164580B2 (ja) 1990-09-27 1990-09-27 ディジタルサーボ制御装置

Publications (2)

Publication Number Publication Date
JPH04135215A JPH04135215A (ja) 1992-05-08
JP3164580B2 true JP3164580B2 (ja) 2001-05-08

Family

ID=17331203

Family Applications (1)

Application Number Title Priority Date Filing Date
JP25922990A Expired - Fee Related JP3164580B2 (ja) 1990-09-27 1990-09-27 ディジタルサーボ制御装置

Country Status (3)

Country Link
US (1) US5313147A (ja)
EP (1) EP0479136A1 (ja)
JP (1) JP3164580B2 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101585118B1 (ko) * 2014-08-18 2016-01-13 한국전기연구원 서보 제어 장치

Families Citing this family (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0480419B1 (en) * 1990-10-11 1997-07-23 Canon Kabushiki Kaisha Positioning device
JP2840139B2 (ja) * 1991-04-24 1998-12-24 ファナック株式会社 予見繰り返し制御装置
JP2697399B2 (ja) * 1991-09-13 1998-01-14 三菱電機株式会社 位置決め装置及びそのプログラム表示方法
JPH05118302A (ja) * 1991-09-25 1993-05-14 Toshiba Corp サーボモータの制御装置
JPH05292753A (ja) * 1992-04-10 1993-11-05 Meidensha Corp Pwmインバータの電流検出方法
EP0596141A4 (en) * 1992-05-22 1994-11-30 Fanuc Ltd METHOD FOR CONTROLLING AN ACTUATOR.
JP3331734B2 (ja) * 1993-05-18 2002-10-07 株式会社明電舎 回転電機の制御方式
US5675562A (en) 1995-03-20 1997-10-07 Fujitsu Limited Seek control method in optical storage device
KR100267364B1 (ko) * 1996-04-30 2000-10-16 윤종용 전류콘트롤 에러를 줄이기 위한 적응피이드 포워드 장치
US6470225B1 (en) 1999-04-16 2002-10-22 Siemens Energy & Automation, Inc. Method and apparatus for automatically tuning feedforward parameters
SG84531A1 (en) * 1999-05-20 2001-11-20 Univ Singapore Disturbance attenuation in a precision servomechanism by a frequency-separated acceleration soft sensor
US6198246B1 (en) 1999-08-19 2001-03-06 Siemens Energy & Automation, Inc. Method and apparatus for tuning control system parameters
JP4137386B2 (ja) * 1999-10-20 2008-08-20 株式会社牧野フライス製作所 数値制御工作機械の制御方法及び数値制御工作機械
US6313591B1 (en) * 2000-02-17 2001-11-06 Siemens Aktiengesellschaft Delay time modeling filter for cascaded regulator structure
KR100873237B1 (ko) * 2000-09-21 2008-12-10 지에스아이 루모닉스 코포레이션 디지털 제어 서보 시스템
US6622080B2 (en) * 2001-07-26 2003-09-16 Motorola, Inc. Tracking control for electronic throttle systems
GB0313887D0 (en) * 2003-06-16 2003-07-23 Gsi Lumonics Ltd Monitoring and controlling of laser operation
US20050165590A1 (en) * 2004-01-23 2005-07-28 Yuhong Huang System and method for virtual laser marking
JP2006201148A (ja) * 2004-12-22 2006-08-03 Toshiba Mach Co Ltd 信号処理装置、信号処理方法、信号処理プログラム、信号処理プログラムを記録した記録媒体、速度検出装置、サーボ機構
JP4256353B2 (ja) * 2005-02-17 2009-04-22 ファナック株式会社 サーボ制御装置及びサーボ系の調整方法
US6979795B1 (en) * 2005-03-18 2005-12-27 Sodick Co., Ltd. Sinker electric discharge machine jump control device
JP4585346B2 (ja) * 2005-03-24 2010-11-24 太平洋セメント株式会社 超音波モータの制御方法
JP4507110B2 (ja) * 2005-11-18 2010-07-21 株式会社安川電機 ディジタルサーボ制御装置
US7586286B2 (en) * 2006-11-17 2009-09-08 Continental Automotive Systems Us, Inc. Method and apparatus for motor control
JP5609214B2 (ja) * 2010-04-02 2014-10-22 セイコーエプソン株式会社 プロジェクターおよびその制御方法
JP5628994B2 (ja) * 2013-01-21 2014-11-19 ファナック株式会社 モータがオーバーヒート温度に達するまでの時間を推定する時間推定手段を有する工作機械の制御装置
EP3062180B1 (de) * 2015-02-25 2018-07-11 Siemens Aktiengesellschaft Verfahren zur überprüfung der positioniergenauigkeit eines mittels eines antriebs und einer steuerung bezüglich wenigstens einer achse verstellbaren maschinenteils
CN112511395A (zh) * 2020-11-06 2021-03-16 云浮中科石材创新科技有限公司 一种驱控一体化控制***
CN113093647B (zh) * 2021-03-26 2022-05-20 华中科技大学 基于数控机床响应数据的反向间隙辨识方法及装置

Family Cites Families (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2315116A1 (fr) * 1975-06-17 1977-01-14 Actimex Sa Dispositif de commande numerique de machines-outils
US4200827A (en) * 1977-06-29 1980-04-29 International Business Machines Corporation Positioning system employing feedforward and feedback control
US4243923A (en) * 1979-01-22 1981-01-06 Massachusetts Institute Of Technology Servo-controlled mobility device
US4282468A (en) * 1979-04-16 1981-08-04 Hyper-Loop, Inc. High speed position feedback and comparator system
US4533991A (en) * 1982-12-29 1985-08-06 Storage Technology Corporation Adaptive feedforward servo system
JPS59161708A (ja) * 1983-03-04 1984-09-12 Fanuc Ltd サ−ボ駆動ユニツト
US4540925A (en) * 1983-09-08 1985-09-10 Contraves Goerz Corporation Control system for electric motor
US4453116A (en) * 1983-10-05 1984-06-05 General Electric Company Scalar decoupled control for an induction machine using current control
JPS60186384A (ja) * 1984-03-07 1985-09-21 株式会社日立製作所 ロボツトの駆動装置
JP2679783B2 (ja) * 1987-01-24 1997-11-19 ファナック 株式会社 加減速制御装置
JPH0693208B2 (ja) * 1987-02-04 1994-11-16 フアナツク株式会社 サーボ遅れ補正方法
JPH0695290B2 (ja) * 1987-02-21 1994-11-24 フアナツク株式会社 数値制御装置におけるインターフェイス方法
JPH0783625B2 (ja) * 1987-04-03 1995-09-06 三菱電機株式会社 検出ヘツドの速度制御装置
JPH0738136B2 (ja) * 1988-08-22 1995-04-26 三菱電機株式会社 位置決め制御装置
US4931712A (en) * 1988-12-28 1990-06-05 Pitney Bowes Inc. Multiple channel servo configuration
JP2762364B2 (ja) * 1989-03-20 1998-06-04 ファナック株式会社 サーボモータのフィードフォワード制御方法
US5062064A (en) * 1989-09-01 1991-10-29 Berkeley Process Control, Inc. Method and apparatus for measuring velocity in servo systems
US5063335A (en) * 1990-09-11 1991-11-05 Allen-Bradley Company, Inc. Two-input control with independent proportional and integral gains for velocity error and velocity feedforward including velocity command limiting

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101585118B1 (ko) * 2014-08-18 2016-01-13 한국전기연구원 서보 제어 장치

Also Published As

Publication number Publication date
EP0479136A1 (en) 1992-04-08
JPH04135215A (ja) 1992-05-08
US5313147A (en) 1994-05-17

Similar Documents

Publication Publication Date Title
JP3164580B2 (ja) ディジタルサーボ制御装置
US5309075A (en) Digital servo-control apparatus for preventing torque variations
JP2018536381A (ja) 電気モーターを制御する方法及びシステム
JP2830274B2 (ja) 可変速駆動装置の電流制御方式
US5726545A (en) Current controlling method for servo motor
JP2943377B2 (ja) 誘導電動機のベクトル制御装置
JP3527069B2 (ja) 電動機のディジタル電流制御装置
JPH07170799A (ja) 交流電動機の制御方法と装置および電動機電流の補正方法
JPH0691482A (ja) 送り制御装置
JP3236607B2 (ja) ディジタルサーボ制御装置
WO1989010655A1 (en) Current control device for pwm control
JPH04271412A (ja) ディジタルサーボ制御装置
JPH04299087A (ja) ディジタルサーボ制御装置
JPH089697A (ja) 誘導電動機のベクトル制御装置
JPH05268789A (ja) モータの電流制御装置
JP3343986B2 (ja) ディジタルサーボ制御装置
JP2014073029A (ja) 交流電動機の制御装置
JPH04135217A (ja) ディジタルサーボ制御装置
JPH07104857A (ja) ディジィタルサーボ制御装置
JPH05204461A (ja) ディジタルサーボ制御装置
JPH03284184A (ja) ディジタルサーボ制御装置
JPH03277194A (ja) ディジタルサーボ制御装置
JP3164748B2 (ja) 誘導モータの制御装置
JPH0222637B2 (ja)
JPH0568391A (ja) 誘導電動機のベクトル制御におけるすべり補償回路

Legal Events

Date Code Title Description
S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313111

R371 Transfer withdrawn

Free format text: JAPANESE INTERMEDIATE CODE: R371

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313111

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090302

Year of fee payment: 8

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100302

Year of fee payment: 9

LAPS Cancellation because of no payment of annual fees