JP2018019462A - サーボモータ制御装置、サーボモータ制御方法、及びサーボモータ制御用プログラム - Google Patents

Abstract

【課題】速度制御ループに遅れ時間が存在する場合でも、応答性を高める。【解決手段】サーボモータを駆動する速度指令値を作成する速度指令作成部と、サーボモータの速度を検出する速度検出部と、速度指令値と速度検出値との差を用いてトルク指令値を作成するトルク指令作成部と、を具備し、トルク指令作成部は比例ゲインと、積分ゲイン及び積分器とを有し、比例項の計算周期は、積分項の計算周期よりも短く、積分ゲインは、初期値に、サーボモータのロータイナーシャに対する機械の総イナーシャの比と、速度制御ループの遅れ時間に応じて速度ゲイン倍率の２乗よりも小さくした値とを乗算したものとし、比例ゲインは、初期値に、サーボモータのロータイナーシャに対する機械の総イナーシャの比と、速度ゲイン倍率とを乗算したものに、積分項と比例項の計算周期の差と、積分ゲインとに応じた値を加算したものとする。【選択図】図２

Description

本発明は、サーボモータ制御装置、サーボモータ制御方法、及びサーボモータ制御用プログラムに関する。

サーボモータは送り軸を駆動する用途等に使用される。サーボモータの速度を制御する速度制御ループには、一般的にＰＩＤ制御（Proportional-Integral-Differential Control）が制御則として採用され、比例ゲインと積分ゲイン、場合によっては微分ゲインが存在する。
速度制御ループゲインの最適値は、モータ単体だけではなく、サーボモータに接続される機械の特性（負荷イナーシャ比や共振周波数など）にも依存して決まる。

サーボモータはさまざまな機械の駆動軸等として使用されるため、予め最適値を決めておくことができない。そこで、モータ単体である応答性になるように速度制御ループゲインの初期値を決め、その初期値に定数を乗算することで機械に合わせた応答性が得られるように調整が行われている。速度制御ループゲインの初期値は、速度制御ループがモータ単体である応答性になるようにモータ毎に決められている。

特許文献１では、制御系に遅れ時間が存在しない場合に、減衰特性を一定に保ちながら応答性を大きくするために、積分ゲインを比例ゲイン倍率の２乗で大きくしていくことの開示がある。

特開平６−３１９２８４号公報（段落０１０９−０１１７等）

しかし、速度制御ループには、速度制御ループの内側にある電流制御ループの応答性による遅れ、速度検出器の通信の遅れ、速度制御ループの計算周期による遅れ等の遅れが存在するため、積分ゲインを比例ゲイン倍率の２乗で大きくしていくと、速度ゲインは積分ゲインのみによる限界で制限されてしまい、比例ゲインを十分に高くとることができないことになる。

本発明は、速度制御ループの積分項と比例項の計算周期が異なるマルチレート系において、速度制御ループに遅れ時間が存在する場合においても、応答性を高めることができる、サーボモータ制御装置、サーボモータ制御方法、及びサーボモータ制御用プログラムを提供することを目的とする。

本発明に係るサーボモータ制御装置は、サーボモータを駆動するための速度指令値を作成する速度指令作成部と、
前記サーボモータの速度を検出する速度検出部と、
前記速度指令作成部が作成した前記速度指令値と前記速度検出部が検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令作成部と、
を具備し、
速度制御ループは前記速度検出部と前記トルク指令作成部とを有し、
前記トルク指令作成部は前記差が入力される比例ゲインと、前記差が入力される積分ゲイン及び積分器とを有し、
前記比例ゲインにより比例項を計算する計算周期は、前記積分ゲイン及び前記積分器により積分項を計算する計算周期よりも短く、
前記積分ゲインは、モータモデル毎にあらかじめ決められた前記積分ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度制御ループの遅れ時間に応じて速度ゲイン倍率の２乗よりも小さくした値とを乗算したものとし、
前記比例ゲインは、前記モータモデル毎に予め決められた前記比例ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度ゲイン倍率とを乗算したものに、前記積分項と前記比例項の計算周期の差と、前記積分ゲインとに応じた値を加算したものとすることを特徴とするサーボモータ制御装置である。

本発明に係るサーボモータ制御方法は、サーボモータを駆動するための速度指令値を作成し、
前記サーボモータの速度を検出し、
作成した前記速度指令値と、検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成し、
前記トルク指令値によって、前記サーボモータを制御する、サーボモータ制御装置のサーボモータ制御方法において、
速度制御ループで少なくとも前記サーボモータの速度の検出と、前記トルク指令値の作成とを行い、
前記トルク指令値の作成は前記差が入力される比例ゲインと、前記差が入力される積分ゲイン及び積分器とを用いて行い、前記比例ゲインにより比例項を計算する計算周期は、前記積分ゲイン及び前記積分器により積分項を計算する計算周期よりも短く、
前記積分ゲインは、モータモデル毎に予め決められた前記積分ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度制御ループの遅れ時間に応じて速度ゲイン倍率の２乗よりも小さくした値とを乗算したものとし、
前記比例ゲインは、前記モータモデル毎に予め決められた前記比例ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度ゲイン倍率とを乗算したものに、前記積分項と前記比例項の計算周期の差と、前記積分ゲインとに応じた値を加算したものとすることを特徴とするサーボモータ制御方法である。

本発明に係るサーボモータ制御用プログラムは、サーボモータを制御するサーボモータ制御装置としてのコンピュータに、
前記サーボモータを駆動するための速度指令値を作成する速度指令作成処理と、
前記サーボモータの速度を検出する速度検出処理と、
作成した前記速度指令値と検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令作成処理と、を実行させ、
速度制御ループで少なくとも前記速度検出処理と前記トルク指令作成処理とを行い、
前記トルク指令作成処理は前記差が入力される比例ゲインと、前記差が入力される積分ゲイン及び積分器とによって行い、前記比例ゲインにより比例項を計算する計算周期は、前記積分ゲイン及び前記積分器により積分項を計算する計算周期よりも短く、
前記積分ゲインは、モータモデル毎に予め決められた前記積分ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度制御ループの遅れ時間に応じて速度ゲイン倍率の２乗よりも小さくした値とを乗算したものとし、
前記比例ゲインは、前記モータモデル毎に予め決められた前記比例ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度ゲイン倍率とを乗算したものに、前記積分項と前記比例項の計算周期の差と、前記積分ゲインとに応じた値を加算したものとすることを特徴とするサーボモータ制御用プログラムである。

本発明によれば、速度制御ループの積分項と比例項の計算周期が異なるマルチレート系において、速度制御ループに遅れ時間が存在する場合においても、応答性を高めることができる。

制御系に遅れ時間が存在しない場合の制御系のブロック図である。 本発明の一実施形態のサーボモータ制御装置及びサーボモータを示すブロック図である。 制御系に遅れ時間が存在せず、積分項と比例項の計算周期が異なる場合の制御系のブロック図である。 図１に示されたサーボモータ制御装置の動作を示すフローチャートである。 速度ゲイン倍率を求める方法を示すフローチャートである。 速度指令作成部、位置検出部、位置指令作成部、及びサーボモータを示すブロック図である。 値βと遅れ時間τとの関係を示す特性図である。

以下、本発明の一実施形態について図面を用いて詳細に説明する。
速度制御ループに遅れ時間が存在しない場合の、本発明の実施形態の前提となる技術について説明する。
従来は機械の剛性が高くなかった点と、高周波の機械共振を回避するためのフィルタ技術が十分でなかった点から、速度制御ループゲインの初期値に掛かる倍率はそれほど高く設定されていなかった。

しかし、機械の剛性が高くなり、機械共振を回避するフィルタ技術の向上により速度制御ループゲインの初期値からの倍率が高くなってきた。
制御系に遅れ時間がまったく存在しないとすると、制御系のブロック図は図１に示すようなブロック図である。
外乱ｄから出力ｙまでの伝達関数は、数式１（数１として示す）となる。

積分ゲインｋ_ｉと比例ゲインｋ_ｐをカットオフ周波数ω_ｎと減衰係数ζで表すと、数式（数２として示す）となる。

これを次のように数式３（数３として示す）のように変形する。

モータモデルごとに、ある基準の応答性で予め決められた、積分ゲインの初期値は以下の数式４（数４として示す）のように決め、比例ゲインの初期値は数式５（数５として示す）のように決める。

従来は比例ゲインと積分ゲインとを同じ倍率で上げることで調整を行っていた。負荷イナーシャ比を考慮するためであればこれで良いが、これによって応答性も調整すると、減衰特性がゲイン倍率によって変わってしまうという課題があった。また、速度ゲインの限界は比例ゲインのみで制限されるため、積分ゲインを高くとることができなかった。
速度制御ループに遅れ時間が存在しない場合に、既に説明したように、特許文献１では、減衰特性を一定に保ちながら応答性を大きくするために、積分ゲインは比例ゲイン倍率の２乗で大きくしていた。

以下、本発明の実施形態について図面を用いて詳細に説明する。
本実施形態は、速度制御ループの積分項と比例項の計算周期が異なるマルチレート系において、速度制御ループに遅れ時間が存在する場合においても、応答性を高めることができるようにしたものである。
図２は本発明の一実施形態のサーボモータ制御装置及びサーボモータを示すブロック図である。図２に示すサーボモータ制御装置は、サーボモータ１０の回転の速度を検出して速度値を出力する速度検出部２０、サーボモータ１０に対する速度指令を作成して出力する速度指令作成部３０、トルク指令作成部４０及び速度指令値と速度値との差を求める減算器５０を備えている。トルク指令作成部４０は、減算器５０と接続される、比例ゲイン４０１及び積分ゲイン４０２、積分ゲイン４０２と接続される積分器４０３、速度指令と検出された速度とを用いて、速度制御ループで生ずる遅れ時間を検出する遅れ検出部４０４、比例ゲイン４０１と積分ゲインのゲインを調整するゲイン制御部４０５、及び比例ゲイン４０１の出力と積分器４０３の出力とを加算し、トルク指令としてサーボモータ１０に出力する加算器４０６を備えている。積分ゲイン４０２は入力に係数を乗算し、積分器４０３は積分ゲイン４０２の出力を積分する。比例ゲイン４０１は入力に係数を乗算する。なお、積分ゲイン４０２と積分器４０３は並び順を変えてもよい。サーボモータ１０は工作機械、産業機械の軸を駆動する。

応答性を高くするためには、速度制御ループを実行する周期を短くすることが求められる。しかし、速度制御ループを実行する周期を短くするためには制御を実行するプロセッサに、高い計算処理能力が要求される。
通常、積分項は、比例項よりも応答性が遅くなる。そこで、より応答性が高い比例項の計算のみを短い周期で実行することにより、処理時間の増加を抑えつつ、高い応答性を得ることができる。図２において、積分項は積分ゲイン４０２と積分器４０３により生成され、比例項は比例ゲイン４０１により生成される。
比例項の演算を積分項の演算に比べて高速で行った場合、積分項は比例項に対して遅れ時間を持っていると考えることができ、ブロック図は図３に示すようになる（図３では、制御対象の遅れ時間は０としている）。

制御器の伝達関数C(s)は数式６（数６として示す）となる。

数式６のテイラー展開により１次の項まで近似すると、数式６は数式７（数７として示す）となる。

したがって、積分ゲインｋ_ｉは数式８（数８として示す）で示され、比例ゲインｋ_ｐは数式９（数９として示す）で示される。

ここで、（１＋Ｊ_Ｌ／Ｊ_ｍ）はＪ／Ｊ_ｍとなり、Ｊ／Ｊ_ｍはサーボモータのロータイナーシャに対する機械の総イナーシャの比となる。また、ω_ｎ／ω_ｎ０は速度ゲイン倍率ＶＧである。比例ゲイン倍率は速度ゲイン倍率ＶＧ（ＶＧ＝ω_ｎ／ω_ｎ０）、積分ゲイン倍率は速度ゲイン倍率ＶＧの２乗となる。δｋ_ｉは、「積分項と比例項の計算周期の差と積分ゲインとに応じた値」の一例で、具体的には「積分項と比例項の計算周期の差と積分ゲインとの積」が挙げられる。

速度制御ループに遅れ時間が存在する場合は、積分ゲイン倍率を比例ゲイン倍率の２乗で大きくすると、倍率を大きくするにつれて積分ゲインが過剰になることが分かった。積分ゲインが過剰になると、オーバシュートが大きくなり、振動的になってしまう。本発明者は遅れ時間に応じて比例ゲイン倍率の２乗よりも小さい値を積分ゲインに掛けることで（積分ゲイン倍率＜比例ゲイン倍率の２乗とする）、減衰特性をあまり変えずに、応答性を高めることができることを見出した。

積分ゲイン倍率を比例ゲイン倍率の２乗よりも小さい値とするために、本実施形態では、（積分ゲイン倍率）＝（比例ゲイン倍率）^β（１≦β＜２）で求める。ただし、本実施形態で示したこれらの方法は一例であり、その他の方法により積分ゲイン倍率を比例ゲイン倍率の２乗よりも小さい値としてもよい。値βは速度制御ループで生ずる遅れ時間を用いて決めることができる。速度制御ループで生ずる遅れ時間は、既に説明したように、電流制御ループの応答性による遅れ、速度検出器の通信の遅れ、速度制御ループの計算周期による遅れ等によって生ずるが、この遅れはモータ特性や速度制御ループを構成する回路の特性で決まり、予め決めることができる。よって、値βも予め決めることができる。

本実施形態では速度制御ループで生ずる遅れ時間の変動を考慮して、速度指令と検出された速度とを用いて、遅れ検出部４０４によって速度制御ループで生ずる遅れ時間を検出している。速度指令に対する、フィールドバックされる速度の遅れ時間を測定することで、速度制御ループで生ずる遅れ時間を検出することができる。値βを予め決める場合には、図２の遅れ検出部４０４は不要である。

数式８及び数式９において、例えば、積分ゲイン倍率＝比例ゲイン倍率のβ乗（１≦β＜２）とすると、積分ゲインｋ_ｉ、比例ゲインｋ_ｐはそれぞれ数式１０（数１０として示す）、数式１１（数１１として示す）で示される。

積分ゲイン倍率は速度ゲイン倍率ＶＧのβ乗（ＶＧ^β＝（ω_ｎ／ω_ｎ０）^β）となる。積分ゲイン倍率のβの値は出荷時に予め決めておくことができるが、速度ゲイン倍率ＶＧは機械特性の影響を受けるため、出荷時に予め決めておくことはできないので、サーボモータに接続される工作機械等の特性に従って適宜設定する。
（ω_ｎ／ω_ｎ０）^β（１≦β＜２）は、「速度ゲイン倍率（係数α）の２乗よりも小さくした値」の一例で、「１以上で２より小さい値をとる定数βを使用して速度ゲイン倍率（係数α）のβ乗とする値である。
本発明者らによる知見によれば、上記数式１０のように、積分ゲイン倍率は、積分ゲイン倍率＝比例ゲイン倍率のβ乗（１≦β＜２）で求めることができる。また、本発明者らによる知見によれば、βは遅れ時間τと定数γを用いて、β＝２−γτと１次関数で表せる。この関係を用いて、遅れ時間τからβの値を求めることができる。αは固定値で、γ＝０．２５付近の値をとることができる。値βと遅れ時間τとの関係の一例を図７の特性図に示す。

図４は図２に示されたサーボモータ制御装置の動作を示すフローチャートである。
まず、ステップＳ１０１において、速度指令作成部３０が速度指令を作成し、ステップＳ１０２において速度検出部２０が速度を検出する。次に、ステップＳ１０３において、ゲイン制御部４０５は、モータモデルごとに予め決められた初期値に、ロータイナーシャに対する機械の総イナーシャの比（Ｊ／Ｊ_ｍ）と、制御系（速度制御ループ）の遅れ時間に応じて速度ゲイン倍率（係数α）の２乗よりも小さくした値を乗算して積分ゲインを求める。次にステップＳ１０４において、ゲイン制御部４０５は、モータモデルごとに予め決められた初期値に、ロータイナーシャに対する機械の総イナーシャの比（Ｊ／Ｊ_ｍ）と、速度ゲイン倍率（係数α）を乗算したものに、積分項と比例項の計算周期の差と積分ゲインに応じた値を加算したものを比例ゲインとする。次に、ステップＳ１０５において、速度指令値と速度値との差を求め、その差を用いて、積分ゲイン４０２の出力値を積分した積分器４０３の出力値と、比例ゲイン４０１の出力値とを加算器４０６で加算してトルク指令を作成し、出力する。

図５は速度ゲイン倍率（係数α）を求める方法を示すフローチャートである。ゲイン制御部４０５は、値βを、モータ特性や速度制御ループを構成する回路の特性から求める（ステップＳ２０１）。次にゲインの安定余裕があるかないかを判断する（ステップＳ２０２）。安定余裕がある場合には速度ゲイン倍率を大きくし（ステップＳ２０３）、ステップＳ２０２に戻る。安定余裕がない場合には初めに設定された速度ゲイン倍率を維持する。

図６は速度指令作成部、位置検出部、位置指令作成部、及びサーボモータを示すブロック図である。
位置指令作成部７０は位置指令を作成し、位置検出部６０はサーボモータ１０の回転の位置を検出する。位置指令値と位置との差を減算器８０で求め、その差を位置制御ゲイン３０１と微分部３０２とに入力する。加算器３０４は、微分部３０２の出力に係数を乗算する係数部３０３の出力と、位置制御ゲイン３０１の出力との加算値を速度指令として出力する。

以上、本発明の実施形態について説明したが、サーボモータ制御装置はその機能の全部又は一部をハードウェア、ソフトウェア又はこれらの組み合わせにより実現することができる。ここで、ソフトウェアによって実現されるとは、コンピュータがプログラムを読み込んで実行することにより実現されることを意味する。ハードウェアで構成する場合、サーボモータ制御装置の一部又は全部を、例えば、ＬＳＩ(Large Scale Integrated circuit)、ＡＳＩＣ(Application Specific Integrated Circuit)、ゲートアレイ、ＦＰＧＡ(Field Programmable Gate Array)等の集積回路（ＩＣ）で構成することができる。

ソフトウェアによって実現する場合、サーボモータ制御装置の一部又は全部を、ＣＰＵとプログラムを記憶したハードディスク、ＲＯＭ等の記憶部とを含むコンピュータで構成して、図２のブロック図及び図４のフローチャートに沿ったプログラムに従い、演算に必要な情報をＲＡＭ等の第２の記憶部に記憶し、処理を実行することでサーボモータ制御装置の一部又は全部の動作をプログラムで実行ことができる。プログラムは、プログラムが記録されたＣＤ−ＲＯＭ、ＤＶＤ、フラッシュメモリ等の外部記憶媒体からハードディスク等の記憶部に読み込むことができる。

１０ サーボモータ
２０ 速度検出部
３０ 速度指令作成部
５０ 減算器
６０ 位置検出部
７０ 位置指令作成部
８０ 減算器
４０１ 比例ゲイン
４０２ 積分ゲイン
４０３ 積分器
４０４ 遅れ検出部
４０５ ゲイン制御部
４０６ 加算器

Claims (11)

1. サーボモータを駆動するための速度指令値を作成する速度指令作成部と、
   前記サーボモータの速度を検出する速度検出部と、
   前記速度指令作成部が作成した前記速度指令値と前記速度検出部が検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令作成部と、
   を具備し、
   速度制御ループは前記速度検出部と前記トルク指令作成部とを有し、
   前記トルク指令作成部は前記差が入力される比例ゲインと、前記差が入力される積分ゲイン及び積分器とを有し、
   前記比例ゲインにより比例項を計算する計算周期は、前記積分ゲイン及び前記積分器により積分項を計算する計算周期よりも短く、
   前記積分ゲインは、モータモデル毎に予め決められた前記積分ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度制御ループの遅れ時間に応じて速度ゲイン倍率の２乗よりも小さくした値とを乗算したものとし、
   前記比例ゲインは、前記モータモデル毎に予め決められた前記比例ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度ゲイン倍率とを乗算したものに、前記積分項と前記比例項の計算周期の差と、前記積分ゲインとに応じた値を加算したものとすることを特徴とするサーボモータ制御装置。
2. 前記速度制御ループの遅れ時間に応じて前記速度ゲイン倍率の２乗よりも小さくした値は、前記速度制御ループの遅れ時間に応じて１以上で２より小さい値をとる定数βを使用して、前記速度ゲイン倍率のβ乗とすることを特徴とする請求項１に記載のサーボモータ制御装置。
3. 前記積分項と前記比例項の計算周期の差と、前記積分ゲインとに応じた値は、前記積分項と前記比例項の計算周期の差と前記積分ゲインとの積であることを特徴とする請求項１又は請求項２に記載のサーボモータ制御装置。
4. 前記定数βを、前記速度制御ループの遅れ時間τと定数γを使用して、β＝２−γτとしたことを特徴とする請求項２又は請求項３に記載のサーボモータ制御装置。
5. 前記サーボモータの位置指令値を作成する位置指令作成部と、
   前記サーボモータの位置を検出する位置検出部と、
   を具備し、
   前記速度指令作成部は、前記位置指令作成部が作成した前記位置指令値と、前記位置検出部が検出した位置検出値との差を用いて前記速度指令値を作成することを特徴とする請求項１から４のいずれか１項に記載のサーボモータ制御装置。
6. サーボモータを駆動するための速度指令値を作成し、
   前記サーボモータの速度を検出し、
   作成した前記速度指令値と、検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成し、
   前記トルク指令値によって、前記サーボモータを制御する、サーボモータ制御装置のサーボモータ制御方法において、
   速度制御ループで少なくとも前記サーボモータの速度の検出と、前記トルク指令値の作成とを行い、
   前記トルク指令値の作成は前記差が入力される比例ゲインと、前記差が入力される積分ゲイン及び積分器とを用いて行い、前記比例ゲインにより比例項を計算する計算周期は、前記積分ゲイン及び前記積分器により積分項を計算する計算周期よりも短く、
   前記積分ゲインは、モータモデル毎に予め決められた前記積分ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度制御ループの遅れ時間に応じて速度ゲイン倍率の２乗よりも小さくした値とを乗算したものとし、
   前記比例ゲインは、前記モータモデル毎に予め決められた前記比例ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度ゲイン倍率とを乗算したものに、前記積分項と前記比例項の計算周期の差と、前記積分ゲインとに応じた値を加算したものとすることを特徴とするサーボモータ制御方法。
7. 前記速度制御ループの遅れ時間に応じて前記速度ゲイン倍率の２乗よりも小さくした値は、前記速度制御ループの遅れ時間に応じて１以上で２より小さい値をとる定数βを使用して、前記速度ゲイン倍率のβ乗とすることを特徴とする請求項６に記載のサーボモータ制御方法。
8. 前記積分項と前記比例項の計算周期の差と、前記積分ゲインとに応じた値は、前記積分項と前記比例項の計算周期の差と前記積分ゲインとの積であることを特徴とする請求項６又は請求項７に記載のサーボモータ制御方法。
9. 前記定数βを、前記速度制御ループの遅れ時間τと定数γを使用して、β＝２−γτとしたことを特徴とする請求項７又は請求項８に記載のサーボモータ制御方法。
10. 前記サーボモータの位置指令値を作成し、
    前記サーボモータの位置を検出し、
    作成した前記位置指令値と、検出した位置検出値との差を用いて前記速度指令値を作成することを特徴とする請求項６から９のいずれか１項に記載のサーボモータ制御方法。
11. サーボモータを制御するサーボモータ制御装置としてのコンピュータに、
    前記サーボモータを駆動するための速度指令値を作成する速度指令作成処理と、
    前記サーボモータの速度を検出する速度検出処理と、
    作成した前記速度指令値と検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令作成処理と、を実行させ、
    速度制御ループで少なくとも前記速度検出処理と前記トルク指令作成処理とを行い、
    前記トルク指令作成処理は前記差が入力される比例ゲインと、前記差が入力される積分ゲイン及び積分器とによって行い、前記比例ゲインにより比例項を計算する計算周期は、前記積分ゲイン及び前記積分器により積分項を計算する計算周期よりも短く、
    前記積分ゲインは、モータモデル毎に予め決められた前記積分ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度制御ループの遅れ時間に応じて速度ゲイン倍率の２乗よりも小さくした値とを乗算したものとし、
    前記比例ゲインは、前記モータモデル毎に予め決められた前記比例ゲインの初期値に、前記サーボモータのロータイナーシャに対する機械の総イナーシャの比と、前記速度ゲイン倍率とを乗算したものに、前記積分項と前記比例項の計算周期の差と、前記積分ゲインとに応じた値を加算したものとすることを特徴とするサーボモータ制御用プログラム。

Images