JPH1131015A - 減速機構付きサーボ制御系の制振方法 - Google Patents
減速機構付きサーボ制御系の制振方法Info
- Publication number
- JPH1131015A JPH1131015A JP18847897A JP18847897A JPH1131015A JP H1131015 A JPH1131015 A JP H1131015A JP 18847897 A JP18847897 A JP 18847897A JP 18847897 A JP18847897 A JP 18847897A JP H1131015 A JPH1131015 A JP H1131015A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- load
- motor
- model
- rotational speed
- 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.)
- Granted
Links
Landscapes
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】
【課題】 構成が簡単で実現が容易なモデルを基にして
制振制御を行える減速機構付きサーボ制御系の制振方法
を提供する。 【解決手段】 オブザーバ７により予め定めた制御モデ
ルに基づいてモータ軸の回転速度に換算した負荷の推定
負荷回転速度ωlmを推定する。そして、モータ回転速度
ωm と推定負荷回転速度ωlmとの偏差（ωlm−ωm ）を
求める。この偏差に残留振動を抑制するのに適したゲイ
ンＫｂを乗じて補正値Ｋｂ（ωlm−ωm ）を求める。補
正値Ｋｂ（ωlm−ωm ）を速度指令量ωcmd に加算して
得た補正速度指令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］を
電気制御部４に与える速度指令量ω´cmd とすることに
より残留振動を抑制する。
制振制御を行える減速機構付きサーボ制御系の制振方法
を提供する。 【解決手段】 オブザーバ７により予め定めた制御モデ
ルに基づいてモータ軸の回転速度に換算した負荷の推定
負荷回転速度ωlmを推定する。そして、モータ回転速度
ωm と推定負荷回転速度ωlmとの偏差（ωlm−ωm ）を
求める。この偏差に残留振動を抑制するのに適したゲイ
ンＫｂを乗じて補正値Ｋｂ（ωlm−ωm ）を求める。補
正値Ｋｂ（ωlm−ωm ）を速度指令量ωcmd に加算して
得た補正速度指令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］を
電気制御部４に与える速度指令量ω´cmd とすることに
より残留振動を抑制する。
Description
【０００１】
【発明の属する技術分野】本発明は、被駆動機械部に歯
車減速機やタイミングベルト，チェーン等の減速機構を
備えたサーボ制御系において、モータの起動及び停止時
等に負荷で発生する固有振動数と関わる低周波数域の残
留振動を抑制する減速機構付きサーボ制御系の制振方法
に関するものである。
車減速機やタイミングベルト，チェーン等の減速機構を
備えたサーボ制御系において、モータの起動及び停止時
等に負荷で発生する固有振動数と関わる低周波数域の残
留振動を抑制する減速機構付きサーボ制御系の制振方法
に関するものである。
【０００２】
【従来の技術】図５は、本発明の方法により振動を抑制
する減速機構付きサーボ制御系の一例であるドラム駆動
系の概略図である。この図において、１０１はサーボモ
ータでり、１０２はサーボモータ１０１のロータの回転
を検出するロータリエンコーダであり、１０３はサーボ
モータの出力軸に取付けられた歯車減速機である。歯車
減速機１０３の出力軸にはプーリ１０４が固定されてお
り、このプーリ１０４にはタイミングベルト１０５が掛
けられている。また１０６はコピー機等で用いられる回
転ドラムであり、このドラム１０６の外周にもタイミン
グベルト１０５が掛けられている。ロータリエンコーダ
１０２により検出した速度は、制御装置１０７に入力さ
れる。制御装置１０７はロータリエンコーダ１０２から
出力されたロータ速度ωm をフィードバックしてサーボ
モータの駆動装置に与える速度指令信号ωcmd とロータ
速度ωm との偏差が０となるように、モータロータを回
転させる。
する減速機構付きサーボ制御系の一例であるドラム駆動
系の概略図である。この図において、１０１はサーボモ
ータでり、１０２はサーボモータ１０１のロータの回転
を検出するロータリエンコーダであり、１０３はサーボ
モータの出力軸に取付けられた歯車減速機である。歯車
減速機１０３の出力軸にはプーリ１０４が固定されてお
り、このプーリ１０４にはタイミングベルト１０５が掛
けられている。また１０６はコピー機等で用いられる回
転ドラムであり、このドラム１０６の外周にもタイミン
グベルト１０５が掛けられている。ロータリエンコーダ
１０２により検出した速度は、制御装置１０７に入力さ
れる。制御装置１０７はロータリエンコーダ１０２から
出力されたロータ速度ωm をフィードバックしてサーボ
モータの駆動装置に与える速度指令信号ωcmd とロータ
速度ωm との偏差が０となるように、モータロータを回
転させる。
【０００３】このようなサーボ制御系で、特に制振制御
を行わない場合に残留振動が発生する様子について説明
する。まず図６（Ａ）は、サーボモータ１０１を駆動す
るための速度指令信号ωcmd である。時間０（起動時）
においてサーボモータ１０１を１０００ min-1で回転さ
せるように速度指令信号ωcmd が立上がり、０．２秒後
にサーボモータ１０１を停止させるべく速度指令信号ω
cmd が０になる（停止時）。このときエンコーダ１０２
で検出される検出速度ωm は、図６（Ｂ）に示す通りで
あり、また歯車減速機１０３の出力軸の回転速度（最大
２０ min-1は図６（Ｃ）に示す通りである。負荷の速度
は図６（Ｄ）に示す通りであり、図６（Ｄ）に見られる
振動は、起動時及び停止時に負荷に発生する過渡振動即
ち残留振動である。図６（Ｄ）に示されるような残留振
動が存在している間は、実際に負荷でコピー等の動作が
できず、残留振動がなくなった後に動作に入ることにな
る。
を行わない場合に残留振動が発生する様子について説明
する。まず図６（Ａ）は、サーボモータ１０１を駆動す
るための速度指令信号ωcmd である。時間０（起動時）
においてサーボモータ１０１を１０００ min-1で回転さ
せるように速度指令信号ωcmd が立上がり、０．２秒後
にサーボモータ１０１を停止させるべく速度指令信号ω
cmd が０になる（停止時）。このときエンコーダ１０２
で検出される検出速度ωm は、図６（Ｂ）に示す通りで
あり、また歯車減速機１０３の出力軸の回転速度（最大
２０ min-1は図６（Ｃ）に示す通りである。負荷の速度
は図６（Ｄ）に示す通りであり、図６（Ｄ）に見られる
振動は、起動時及び停止時に負荷に発生する過渡振動即
ち残留振動である。図６（Ｄ）に示されるような残留振
動が存在している間は、実際に負荷でコピー等の動作が
できず、残留振動がなくなった後に動作に入ることにな
る。
【０００４】このような残留振動を抑制する技術は、種
々提案されている。例えば一般的には、機械系の固有振
動数と関わって負荷で発生する残留振動を抑制する方法
として、エンドエフェクタ（負荷）に速度や加速度を機
械的に検出する検出器を設け、この検出器で検出した状
態量をフィードバックして振動を抑制するようにフルク
ローズドループ制御する方法である。このような検出器
を用いて負荷の速度や加速度を検出して残留振動を抑制
する方法を実現するためには、制御装置の構成が複雑と
なり、実現のためのコストが高くなる問題がある。
々提案されている。例えば一般的には、機械系の固有振
動数と関わって負荷で発生する残留振動を抑制する方法
として、エンドエフェクタ（負荷）に速度や加速度を機
械的に検出する検出器を設け、この検出器で検出した状
態量をフィードバックして振動を抑制するようにフルク
ローズドループ制御する方法である。このような検出器
を用いて負荷の速度や加速度を検出して残留振動を抑制
する方法を実現するためには、制御装置の構成が複雑と
なり、実現のためのコストが高くなる問題がある。
【０００５】そこで最近、実際に負荷の速度や加速度を
検出する機械的な検出器を用いずに、検出可能なモータ
の操作量とモータ制御系内の状態量とを入力とし、負荷
の速度や加速度を推定するオブザーバ即ち推定手段を用
いて、推定した負荷の速度や加速度をフィードバックす
ることにより残留振動を抑制する方法が提案された。例
えば特開平８−２７８８２０号公報に示された方法で
は、負荷の速度をオブザーバで推定し、特開平８−２７
８８２１号公報に示された方法では、負荷の加速度をオ
ブザーバで推定して、残留振動を抑制する。
検出する機械的な検出器を用いずに、検出可能なモータ
の操作量とモータ制御系内の状態量とを入力とし、負荷
の速度や加速度を推定するオブザーバ即ち推定手段を用
いて、推定した負荷の速度や加速度をフィードバックす
ることにより残留振動を抑制する方法が提案された。例
えば特開平８−２７８８２０号公報に示された方法で
は、負荷の速度をオブザーバで推定し、特開平８−２７
８８２１号公報に示された方法では、負荷の加速度をオ
ブザーバで推定して、残留振動を抑制する。
【０００６】
【発明が解決しようとする課題】従来のオブザーバを用
いる方法では、負荷系の精密なモデル式を必要としてい
る。しかしながら、このような精密なモデル式を実現す
ることは容易ではない。例えば、特開平８−２７８８２
０号公報に示された技術では、この公報の第３頁に記載
された式（３）及び（４）中の回転角加速度θa ”の算
出過程が不明なために、精密なモデル式を実現すること
が不可能な状態になっている。言い換えれば、この公報
には実施不可能な技術が開示されている。実施不可能で
あるが、この公報に示された技術では、オブザーバ回路
において、モータのトルク指令Ｔと検出速度θｍ´とが
オブザーバ回路を構成する演算回路に入力され、これら
の入力と定数とにより角速度を推定している。これに対
して特開平８−２７８８２１号公報に示された技術で
は、速度検出器で検出した検出速度θｍ´と位置検出器
で検出した位置θｍと、速度指令信号とを入力として、
オブザーバ回路で加速度を推定している。この公報で
は、回転角加速度θa ”の算出過程が明確に示されてい
るため、精密なモデル式を実現することは困難である
が、フィードバックループに微分器またはノイズの発生
処理のためのローパスフィルタ付きの微分器を用いる必
要があり、この方法を実現するための構成が複雑にな
る。
いる方法では、負荷系の精密なモデル式を必要としてい
る。しかしながら、このような精密なモデル式を実現す
ることは容易ではない。例えば、特開平８−２７８８２
０号公報に示された技術では、この公報の第３頁に記載
された式（３）及び（４）中の回転角加速度θa ”の算
出過程が不明なために、精密なモデル式を実現すること
が不可能な状態になっている。言い換えれば、この公報
には実施不可能な技術が開示されている。実施不可能で
あるが、この公報に示された技術では、オブザーバ回路
において、モータのトルク指令Ｔと検出速度θｍ´とが
オブザーバ回路を構成する演算回路に入力され、これら
の入力と定数とにより角速度を推定している。これに対
して特開平８−２７８８２１号公報に示された技術で
は、速度検出器で検出した検出速度θｍ´と位置検出器
で検出した位置θｍと、速度指令信号とを入力として、
オブザーバ回路で加速度を推定している。この公報で
は、回転角加速度θa ”の算出過程が明確に示されてい
るため、精密なモデル式を実現することは困難である
が、フィードバックループに微分器またはノイズの発生
処理のためのローパスフィルタ付きの微分器を用いる必
要があり、この方法を実現するための構成が複雑にな
る。
【０００７】本発明の目的は、負荷の性能を決定する主
な要因が、機械系の第１次の振動モードと関わる残留振
動であることを考慮して、構成が簡単で実現が容易なモ
デルを基にして制振制御を行える減速機構付きサーボ制
御系の制振方法を提供することにある。
な要因が、機械系の第１次の振動モードと関わる残留振
動であることを考慮して、構成が簡単で実現が容易なモ
デルを基にして制振制御を行える減速機構付きサーボ制
御系の制振方法を提供することにある。
【０００８】
【課題を解決するための手段】本発明は、モータを含む
駆動部によって駆動される被駆動機械部に減速機構を有
するサーボ制御系において負荷で発生する機械系の固有
振動数と関わる低周波数域の残留振動を抑制する減速機
構付きサーボ制御系の制振方法を改良の対象とする。本
発明では、まず負荷の回転速度をモータ軸の回転速度に
換算して推定する関係を予め設定しておく。具体的に
は、負荷の回転速度を直接推定したとすれば、この推定
した負荷の回転速度に減速機構の減速比（出力軸回転数
／入力軸回転数）の逆数を乗じて得られる速度が、モー
タ軸の回転速度に換算した負荷の回転速度となる。但
し、負荷の回転速度を直接推定せずに、モータ軸の回転
速度に換算した負荷の回転速度を求めてもよい。そして
推定した負荷の回転速度とモータの回転速度との偏差を
残留振動を抑制するように速度指令値に加算する。この
ようにすると負荷の速度を実際に検出することなく推定
した負荷の回転速度を用いて残留振動成分を求めること
ができて、実際の残留振動を簡単に抑制できる。
駆動部によって駆動される被駆動機械部に減速機構を有
するサーボ制御系において負荷で発生する機械系の固有
振動数と関わる低周波数域の残留振動を抑制する減速機
構付きサーボ制御系の制振方法を改良の対象とする。本
発明では、まず負荷の回転速度をモータ軸の回転速度に
換算して推定する関係を予め設定しておく。具体的に
は、負荷の回転速度を直接推定したとすれば、この推定
した負荷の回転速度に減速機構の減速比（出力軸回転数
／入力軸回転数）の逆数を乗じて得られる速度が、モー
タ軸の回転速度に換算した負荷の回転速度となる。但
し、負荷の回転速度を直接推定せずに、モータ軸の回転
速度に換算した負荷の回転速度を求めてもよい。そして
推定した負荷の回転速度とモータの回転速度との偏差を
残留振動を抑制するように速度指令値に加算する。この
ようにすると負荷の速度を実際に検出することなく推定
した負荷の回転速度を用いて残留振動成分を求めること
ができて、実際の残留振動を簡単に抑制できる。
【０００９】より具体的には、本発明の減速機構付きサ
ーボ制御系の制振方法は、減速機構を介して負荷を駆動
するモータと、モータの回転速度ωm を検出する速度検
出器を含んでモータ回転速度を帰還量とするフィードバ
ックループと、速度指令量ωcmd と前記帰還量との偏差
を入力としてモータに操作量を与える電気制御部とを有
する減速機構付きサーボ制御系において発生する残留振
動を、予め定めた制御モデルに基づいて推定したモータ
軸換算の（モータ軸の回転速度に換算した）負荷の推定
負荷回転速度ωlmを用いて抑制する。まずモータ回転速
度ωm と推定負荷回転速度ωlmとの偏差（ωlm−ωm ）
を求める。この偏差は、推定による残留振動成分を含
む。そしてこの偏差に残留振動を抑制するのに適したゲ
インＫｂを乗じて補正値Ｋｂ（ωlm−ωm ）を求める。
ゲインＫｂは、補正値Ｋｂ（ωlm−ωm ）を実際に発生
する残留振動を打ち消すことができる値にするように定
められる。ちなみモータの一定回転速度が１０００min
-1で負荷の一定回転速度が２０min -1の場合に、このゲ
インＫｂはシミュレーション値でほぼ０．７５と選択さ
れる。
ーボ制御系の制振方法は、減速機構を介して負荷を駆動
するモータと、モータの回転速度ωm を検出する速度検
出器を含んでモータ回転速度を帰還量とするフィードバ
ックループと、速度指令量ωcmd と前記帰還量との偏差
を入力としてモータに操作量を与える電気制御部とを有
する減速機構付きサーボ制御系において発生する残留振
動を、予め定めた制御モデルに基づいて推定したモータ
軸換算の（モータ軸の回転速度に換算した）負荷の推定
負荷回転速度ωlmを用いて抑制する。まずモータ回転速
度ωm と推定負荷回転速度ωlmとの偏差（ωlm−ωm ）
を求める。この偏差は、推定による残留振動成分を含
む。そしてこの偏差に残留振動を抑制するのに適したゲ
インＫｂを乗じて補正値Ｋｂ（ωlm−ωm ）を求める。
ゲインＫｂは、補正値Ｋｂ（ωlm−ωm ）を実際に発生
する残留振動を打ち消すことができる値にするように定
められる。ちなみモータの一定回転速度が１０００min
-1で負荷の一定回転速度が２０min -1の場合に、このゲ
インＫｂはシミュレーション値でほぼ０．７５と選択さ
れる。
【００１０】そして本発明では、この補正値Ｋｂ（ωlm
−ωm ）を速度指令量ωcmd に加算して得た補正速度指
令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］を速度指令量ω´
cmdとすることにより残留振動を抑制する。
−ωm ）を速度指令量ωcmd に加算して得た補正速度指
令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］を速度指令量ω´
cmdとすることにより残留振動を抑制する。
【００１１】負荷回転速度を推定する場合に用いる制御
モデルは、補正速度指令量［ωcmd＋Ｋｂ（ωlm−
ωm ）］から推定負荷回転速度ωlmを推定するようにモ
デル化されたモデル電気制御部と、モータ，減速機構及
び負荷を含むモデル化されたモデル機械部とから構成さ
れる。そしてモデル電気制御部はその固有振動数ωe と
減衰比ζe とを用いて予めモデル化されており、またモ
デル機械部はその固有振動数ωn と減衰比γn と慣性モ
ーメント比Ｒn とを用いて予めモデル化されているのも
のを用いる。このような制御モデルを用いると、複雑な
構成の制御モデルを用いることなく簡単な制御モデルを
用いて等価的に機械系に減衰効果を持たせることができ
る。
モデルは、補正速度指令量［ωcmd＋Ｋｂ（ωlm−
ωm ）］から推定負荷回転速度ωlmを推定するようにモ
デル化されたモデル電気制御部と、モータ，減速機構及
び負荷を含むモデル化されたモデル機械部とから構成さ
れる。そしてモデル電気制御部はその固有振動数ωe と
減衰比ζe とを用いて予めモデル化されており、またモ
デル機械部はその固有振動数ωn と減衰比γn と慣性モ
ーメント比Ｒn とを用いて予めモデル化されているのも
のを用いる。このような制御モデルを用いると、複雑な
構成の制御モデルを用いることなく簡単な制御モデルを
用いて等価的に機械系に減衰効果を持たせることができ
る。
【００１２】制御モデルのモデル電気制御部及びモデル
機械部の構成は任意であるが、例えばモデル電気制御部
は、補正速度指令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］が
入力される第１の加え合わせ点と第２の加え合わせ点と
の間に２ζe ・ωe ＋ωe 2（１／ｓ）の伝達関数を有
する第１の伝達要素を有し、第２の伝達要素と第３の加
え合わせ点との間に設けられた第１の引き出し点から第
１の加え合わせ点に第１のフィードバックループが形成
された構成にすることができる。このようなモデル電気
制御部を用いる場合、モデル機械部は第２の加え合わせ
点と第３の加え合わせ点との間に１／ｓの伝達関数を有
する第２の伝達要素を有し、第３の加え合わせ点と第４
の加え合わせ点との間に［Ｒn ／（１＋Ｒn ）］・ωn
2 ・（１／ｓ）の伝達関数を有する第３の伝達要素と
［Ｒn ／（１＋Ｒn ）］・２γn ・ωn の伝達関数を有
する第４の伝達要素の並列結合を有し、第４の加え合わ
せ点と出力点との間に１／（Ｒn ・ｓ）の伝達関数を有
する第５の伝達要素を有し、第４の加え合わせ点と第５
の伝達要素との間に設けられた第２の引き出し点から第
２の加え合わせ点に第２のフィードバックループが形成
された構成にすることができる。このような構成の電気
制御部と機械部とを備えた制御モデルを用いると、図面
情報（ここで図面情報とは設計図面や設計仕様書に記載
された各種の情報と定義される。）から求めた電気制御
部及び機械部の定数を用いて簡単に制御モデルを構成で
きるだけでなく、実際に運転を行って得られる実運転デ
ータから求めた電気制御部及び機械部の定数を用いて簡
単に制御モデルを構成できる。
機械部の構成は任意であるが、例えばモデル電気制御部
は、補正速度指令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］が
入力される第１の加え合わせ点と第２の加え合わせ点と
の間に２ζe ・ωe ＋ωe 2（１／ｓ）の伝達関数を有
する第１の伝達要素を有し、第２の伝達要素と第３の加
え合わせ点との間に設けられた第１の引き出し点から第
１の加え合わせ点に第１のフィードバックループが形成
された構成にすることができる。このようなモデル電気
制御部を用いる場合、モデル機械部は第２の加え合わせ
点と第３の加え合わせ点との間に１／ｓの伝達関数を有
する第２の伝達要素を有し、第３の加え合わせ点と第４
の加え合わせ点との間に［Ｒn ／（１＋Ｒn ）］・ωn
2 ・（１／ｓ）の伝達関数を有する第３の伝達要素と
［Ｒn ／（１＋Ｒn ）］・２γn ・ωn の伝達関数を有
する第４の伝達要素の並列結合を有し、第４の加え合わ
せ点と出力点との間に１／（Ｒn ・ｓ）の伝達関数を有
する第５の伝達要素を有し、第４の加え合わせ点と第５
の伝達要素との間に設けられた第２の引き出し点から第
２の加え合わせ点に第２のフィードバックループが形成
された構成にすることができる。このような構成の電気
制御部と機械部とを備えた制御モデルを用いると、図面
情報（ここで図面情報とは設計図面や設計仕様書に記載
された各種の情報と定義される。）から求めた電気制御
部及び機械部の定数を用いて簡単に制御モデルを構成で
きるだけでなく、実際に運転を行って得られる実運転デ
ータから求めた電気制御部及び機械部の定数を用いて簡
単に制御モデルを構成できる。
【００１３】モデル電気制御部の固有振動数ωe を
［（Ｋvm・Ｋtm）／（Ｔim・Ｊmm）］1/ 2 と表し、減衰
比ζe を（１／２）［（Ｔim・Ｋvm・Ｋtm）／Ｊmm］
1/2 と表す。但しＫvmはＰＩ制御の速度ループゲインで
あり、ＴimはＰＩ制御の積分時定数であり、Ｋtmはトル
ク定数であり、Ｊmmはモータ軸に換算したモータ側の慣
性モーメントであるとする。また、モデル機械部の固有
振動数ωn を｛Ｋsm［（１／Ｊmm）＋（１／Ｊlm）］｝
1/2 と表し、減衰比γn を｛Ｃsm［（１／Ｊmm）＋（１
／Ｊlm）］｝／２ωn と表す。但しＫsmはモータ軸換算
のねじりばね剛性であり、Ｊlmはモータ軸換算の負荷側
の慣性モーメントであり、Ｃsmはモータ軸換算の減衰定
数である。その上でＫvm，Ｋlm，Ｔim，Ｊmm，Ｋsm，Ｊ
lm，Ｃsmを図面情報より求めれば、簡単に制御モデルを
構成することができる。
［（Ｋvm・Ｋtm）／（Ｔim・Ｊmm）］1/ 2 と表し、減衰
比ζe を（１／２）［（Ｔim・Ｋvm・Ｋtm）／Ｊmm］
1/2 と表す。但しＫvmはＰＩ制御の速度ループゲインで
あり、ＴimはＰＩ制御の積分時定数であり、Ｋtmはトル
ク定数であり、Ｊmmはモータ軸に換算したモータ側の慣
性モーメントであるとする。また、モデル機械部の固有
振動数ωn を｛Ｋsm［（１／Ｊmm）＋（１／Ｊlm）］｝
1/2 と表し、減衰比γn を｛Ｃsm［（１／Ｊmm）＋（１
／Ｊlm）］｝／２ωn と表す。但しＫsmはモータ軸換算
のねじりばね剛性であり、Ｊlmはモータ軸換算の負荷側
の慣性モーメントであり、Ｃsmはモータ軸換算の減衰定
数である。その上でＫvm，Ｋlm，Ｔim，Ｊmm，Ｋsm，Ｊ
lm，Ｃsmを図面情報より求めれば、簡単に制御モデルを
構成することができる。
【００１４】またＫvm，Ｋtm，Ｔimを図面情報より求
め、慣性モーメント比Ｒn ＝Ｊlm／Ｊmmと定義して、Ｊ
lm＝Ｒn ・Ｊmm、Ｋsm＝ωn 2 ・［（Ｒn ・Ｊmm）／
（１＋Ｒn ）］、Ｃsm＝［（２Ｒn ・Ｊmm）／（１＋Ｒ
n ）］・γn ・ωn と表せば、Ｒn ，Ｊmm，ωn ，γn
を実運転データから求めるだけで、簡単に制御モデルを
構成することができる。
め、慣性モーメント比Ｒn ＝Ｊlm／Ｊmmと定義して、Ｊ
lm＝Ｒn ・Ｊmm、Ｋsm＝ωn 2 ・［（Ｒn ・Ｊmm）／
（１＋Ｒn ）］、Ｃsm＝［（２Ｒn ・Ｊmm）／（１＋Ｒ
n ）］・γn ・ωn と表せば、Ｒn ，Ｊmm，ωn ，γn
を実運転データから求めるだけで、簡単に制御モデルを
構成することができる。
【００１５】
【発明の実施の形態】図１は、図５に示すような歯車減
速機構を有する機械系に本発明を適用した実施の形態の
一例のブロック線図である。なおタイミングベルトやチ
ェーン等の減速機構を有する機械系についても、図１と
同様にブロック線図により系全体を表すことができる。
図１において、１が負荷であり、２が減速機であり、３
はサーボモータであり、４はモータ３に操作量を与える
制御部である。電気制御部４は一般的にＰＩ制御部と電
流制御部とから構成される。５はモータの角速度即ちモ
ータ回転速度ωm を検出する速度検出器であり、速度検
出器５から出力されたモータ回転速度ωm に増幅器６で
所定のゲインが乗じられて帰還量が得れる。この帰還量
は後に説明する補正後の速度指令量即ち補正速度指令量
ω´cmd から減算され、その偏差が電気制御部４に入力
されて、負荷は残留振動が制御された回転をする。本発
明では、補正速度指令量ω´cmd を入力として負荷１の
回転速度をモータ軸の回転速度に換算した推定負荷回転
速度ωlmを推定するオブザーバ７を用いる。このオブザ
ーバ７を構成するモデル機械部７Ｂの各定数（図３中の
Ｊmm，Ｋsm，Ｃsm，Ｊlm及び図２中のＲn ）は、減速機
構の減速比を考慮して、モータ軸に換算した値［Ｊmm＝
Ｊm ＋（Ｊg ／Ｒg 2 ）、Ｋsm＝Ｋs ／Ｒg 2 、Ｊlm＝
Ｊl ／Ｒg 2 、Ｃsm＝Ｃs ／Ｒg 2 、Ｒn ＝Ｊlm／
Ｊmm；但しＲg は減速比の逆数］を用いるため、推定負
荷回転速度ωlmは、モータ軸の回転速度に換算した値と
して推定される。
速機構を有する機械系に本発明を適用した実施の形態の
一例のブロック線図である。なおタイミングベルトやチ
ェーン等の減速機構を有する機械系についても、図１と
同様にブロック線図により系全体を表すことができる。
図１において、１が負荷であり、２が減速機であり、３
はサーボモータであり、４はモータ３に操作量を与える
制御部である。電気制御部４は一般的にＰＩ制御部と電
流制御部とから構成される。５はモータの角速度即ちモ
ータ回転速度ωm を検出する速度検出器であり、速度検
出器５から出力されたモータ回転速度ωm に増幅器６で
所定のゲインが乗じられて帰還量が得れる。この帰還量
は後に説明する補正後の速度指令量即ち補正速度指令量
ω´cmd から減算され、その偏差が電気制御部４に入力
されて、負荷は残留振動が制御された回転をする。本発
明では、補正速度指令量ω´cmd を入力として負荷１の
回転速度をモータ軸の回転速度に換算した推定負荷回転
速度ωlmを推定するオブザーバ７を用いる。このオブザ
ーバ７を構成するモデル機械部７Ｂの各定数（図３中の
Ｊmm，Ｋsm，Ｃsm，Ｊlm及び図２中のＲn ）は、減速機
構の減速比を考慮して、モータ軸に換算した値［Ｊmm＝
Ｊm ＋（Ｊg ／Ｒg 2 ）、Ｋsm＝Ｋs ／Ｒg 2 、Ｊlm＝
Ｊl ／Ｒg 2 、Ｃsm＝Ｃs ／Ｒg 2 、Ｒn ＝Ｊlm／
Ｊmm；但しＲg は減速比の逆数］を用いるため、推定負
荷回転速度ωlmは、モータ軸の回転速度に換算した値と
して推定される。
【００１６】速度検出器５で検出したモータ回転速度ω
m とオブザーバ７で推定した推定負荷回転速度ωlmとの
偏差（ωlm−ωm ）が加え合わせ点８で演算されて、そ
の偏差に増幅器９で残留振動を抑制するのに適したゲイ
ンＫｂが乗じられて補正値Ｋｂ（ωlm−ωm ）が決定さ
れる。ゲインＫｂは、補正値Ｋｂ（ωlm−ωm ）を実際
に発生する残留振動を打ち消すことができる値にするよ
うに定められる。この補正値Ｋｂ（ωlm−ωm ）が、加
え合わせ点１０で速度指令量ωcmd に加算されて、補正
速度指令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］が得られ
る。この補正速度指令量［ωcmd ＋Ｋｂ（ωlm−
ωm ）］に加え合わせ点１１で帰還量が減算され速度指
令量ω´cmd となる。
m とオブザーバ７で推定した推定負荷回転速度ωlmとの
偏差（ωlm−ωm ）が加え合わせ点８で演算されて、そ
の偏差に増幅器９で残留振動を抑制するのに適したゲイ
ンＫｂが乗じられて補正値Ｋｂ（ωlm−ωm ）が決定さ
れる。ゲインＫｂは、補正値Ｋｂ（ωlm−ωm ）を実際
に発生する残留振動を打ち消すことができる値にするよ
うに定められる。この補正値Ｋｂ（ωlm−ωm ）が、加
え合わせ点１０で速度指令量ωcmd に加算されて、補正
速度指令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］が得られ
る。この補正速度指令量［ωcmd ＋Ｋｂ（ωlm−
ωm ）］に加え合わせ点１１で帰還量が減算され速度指
令量ω´cmd となる。
【００１７】オブザーバ７は、補正速度指令量に基づい
て負荷の回転速度を推定する関係を予め設定した制御モ
デルに基づいてモータ軸の回転速度に換算した負荷の回
転速度（推定負荷回転速度ωlm）を推定する。負荷回転
速度を推定する場合に用いる制御モデルは、補正速度指
令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］から推定負荷回転
速度ωlmを推定するように、電気制御部４をモデル化し
たモデル電気制御部７Ａ及びモータ３と減速機（減速機
構）２及び負荷１を含むモデル化されたモデル機械部７
Ｂとから構成される。即ち実際に負荷１の回転速度を検
出せずにモータ軸の回転速度に換算した負荷１の回転速
度を推定するために、オブザーバ７の内部の制御モデル
では、サーボ制御系を構成する要素１〜６をモデル化し
ている。この制御モデルでは、推定する負荷の回転速度
中に残留振動成分を含んでいる。
て負荷の回転速度を推定する関係を予め設定した制御モ
デルに基づいてモータ軸の回転速度に換算した負荷の回
転速度（推定負荷回転速度ωlm）を推定する。負荷回転
速度を推定する場合に用いる制御モデルは、補正速度指
令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］から推定負荷回転
速度ωlmを推定するように、電気制御部４をモデル化し
たモデル電気制御部７Ａ及びモータ３と減速機（減速機
構）２及び負荷１を含むモデル化されたモデル機械部７
Ｂとから構成される。即ち実際に負荷１の回転速度を検
出せずにモータ軸の回転速度に換算した負荷１の回転速
度を推定するために、オブザーバ７の内部の制御モデル
では、サーボ制御系を構成する要素１〜６をモデル化し
ている。この制御モデルでは、推定する負荷の回転速度
中に残留振動成分を含んでいる。
【００１８】オブザーバ７で用いる制御モデルは、サー
ボ制御系の構成によって異なってくる。図５に示すよう
な歯車減速機構を有する機械系は、多自由度のねじり振
動系とみなすことができる。歯車減速機構を有する機械
系に対して本発明を適用する場合のより詳しい実施例の
ブロック線図を図２に示す。なお図２において、図１に
示した各要素１〜１１に相当する部分には、図１に付し
た符号と同じ符号を付してある。ここでは簡単のために
歯車段を有する３慣性体からなるサーポ制御系１００を
考えている。このような歯車段を有する機械系では、歯
車接続段のねじり剛性が被駆動部としての負荷の軸やカ
ップリングと比べて高い場合と、被駆動部が剛体とみな
すことができて歯車接続段の剛性が最も低くなる場合と
の二つの場合に大きく分けることができる。いずれの場
合も、高次の自由振動の減衰が十分に速く、低減すべき
残留振動が第１次の固有振動数（固有モード）にのみ支
配される場合が多い。そのため図２の符号１００で示し
た３慣性ねじり振動系の制御系は、図３に示す２慣性ね
じり振動系に縮約できる。この縮約された低次元モデル
において、モータ軸に換算したモータ側の慣性モーメン
ト及び負荷側の慣性モーメントをそれぞれＪmm及びＪlm
とし、Ｋsmをモータ軸換算のねじりばね剛性とし、Ｃsm
をモータ軸換算の減衰定数とすると機械系の固有振動数
ωn と減衰比γn は、下記の式（１）及び（２）のよう
に表される。
ボ制御系の構成によって異なってくる。図５に示すよう
な歯車減速機構を有する機械系は、多自由度のねじり振
動系とみなすことができる。歯車減速機構を有する機械
系に対して本発明を適用する場合のより詳しい実施例の
ブロック線図を図２に示す。なお図２において、図１に
示した各要素１〜１１に相当する部分には、図１に付し
た符号と同じ符号を付してある。ここでは簡単のために
歯車段を有する３慣性体からなるサーポ制御系１００を
考えている。このような歯車段を有する機械系では、歯
車接続段のねじり剛性が被駆動部としての負荷の軸やカ
ップリングと比べて高い場合と、被駆動部が剛体とみな
すことができて歯車接続段の剛性が最も低くなる場合と
の二つの場合に大きく分けることができる。いずれの場
合も、高次の自由振動の減衰が十分に速く、低減すべき
残留振動が第１次の固有振動数（固有モード）にのみ支
配される場合が多い。そのため図２の符号１００で示し
た３慣性ねじり振動系の制御系は、図３に示す２慣性ね
じり振動系に縮約できる。この縮約された低次元モデル
において、モータ軸に換算したモータ側の慣性モーメン
ト及び負荷側の慣性モーメントをそれぞれＪmm及びＪlm
とし、Ｋsmをモータ軸換算のねじりばね剛性とし、Ｃsm
をモータ軸換算の減衰定数とすると機械系の固有振動数
ωn と減衰比γn は、下記の式（１）及び（２）のよう
に表される。
【００１９】 ωn ＝｛Ｋsm［（１／Ｊmm）＋（１／Ｊlm）］｝1/2 …（１） γn ＝｛Ｃsm［（１／Ｊmm）＋（１／Ｊlm）］｝／２ωn …（２） 更に、慣性モーメント比Ｒn をＲn ＝Ｊlm／Ｊmmと定義
すれば、Ｊlm，Ｋsm及びＣsmは、下記の（３）〜（５）
式のように表される。
すれば、Ｊlm，Ｋsm及びＣsmは、下記の（３）〜（５）
式のように表される。
【００２０】 Ｊlm＝Ｒn ・Ｊmm …（３） Ｋsm＝ωn 2 ・［（Ｒn ・Ｊmm）／（１＋Ｒn ）］ …（４） Ｃsm＝［（２Ｒn ・Ｊmm）／（１＋Ｒn ）］・γn ・ωn …（５） このように機械系を低次元簡易モデル化することによ
り、図２のオブザーバ７のモデル機械部７Ｂの被駆動部
分を構成する伝達要素７ｇ，７ｈ及び７ｋの伝達関数を
簡単に定めることができる。なおＲn ，Ｊmm，ωn ，γ
n の値は、シミュレーションに用いる値として図面情報
から得ることができるだけでなく、実際に運転を行って
計測した残留振動波形から得られる実運転データに基づ
いても決定することができる。
り、図２のオブザーバ７のモデル機械部７Ｂの被駆動部
分を構成する伝達要素７ｇ，７ｈ及び７ｋの伝達関数を
簡単に定めることができる。なおＲn ，Ｊmm，ωn ，γ
n の値は、シミュレーションに用いる値として図面情報
から得ることができるだけでなく、実際に運転を行って
計測した残留振動波形から得られる実運転データに基づ
いても決定することができる。
【００２１】次にオブザーバ７のモデル電気制御部７Ａ
の低次元簡易モデルを求める方法について説明する。こ
こでは誘起電圧の影響は無視する。更に電流マイナール
ープが機械系の第１次固有周期に対し、十分速い応答性
を有するものとして、比例ゲインＫtmと置き、図３に示
すごとく簡略化したＰＩ制御系を構成する。更に下記
（６）及び（７）式のごとく電気制御系の固有振動数ω
e と減衰比ζe とを用いて表せば、電気制御部のモデル
定数の設定即ち図１のモデル電気制御部７Ａの伝達要素
７ｂの伝達関数の設定は容易にできる。
の低次元簡易モデルを求める方法について説明する。こ
こでは誘起電圧の影響は無視する。更に電流マイナール
ープが機械系の第１次固有周期に対し、十分速い応答性
を有するものとして、比例ゲインＫtmと置き、図３に示
すごとく簡略化したＰＩ制御系を構成する。更に下記
（６）及び（７）式のごとく電気制御系の固有振動数ω
e と減衰比ζe とを用いて表せば、電気制御部のモデル
定数の設定即ち図１のモデル電気制御部７Ａの伝達要素
７ｂの伝達関数の設定は容易にできる。
【００２２】 ωe ＝［（Ｋvm・Ｋtm）／（Ｔim・Ｊmm）］1/2 …（６） ζe ＝（１／２）［（Ｔim・Ｋvm・Ｋtm）／Ｊmm］1/2 …（７） 但しＫvmはＰＩ制御の速度ループゲインであり、Ｔimは
ＰＩ制御の積分時定数であり、Ｋtmはトルク定数、Ｊmm
はモータ軸に換算したモータ側の慣性モーメントであ
る。
ＰＩ制御の積分時定数であり、Ｋtmはトルク定数、Ｊmm
はモータ軸に換算したモータ側の慣性モーメントであ
る。
【００２３】図１に示したオブザーバ７を構成するブロ
ック線図について説明する。モデル電気制御部７Ａは、
補正速度指令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］が入力
される第１の加え合わせ点７ａと第２の加え合わせ点７
ｃとの間に２ζe ・ωe ＋ωe 2 （１／ｓ）の伝達関数
を有する第１の伝達要素７ｂを有している。そして第２
の伝達要素７ｄと第３の加え合わせ点７ｆとの間に設け
られた第１の引き出し点７ｅから第１の加え合わせ点７
ａに第１のフィードバックループが形成された構成を有
している。モデル機械部７Ｂは、また第２の加え合わせ
点７ｃと第３の加え合わせ点７ｆとの間に１／ｓの伝達
関数を有する第２の伝達要素７ｄを有している。また第
３の加え合わせ点７ｆと第４の加え合わせ点７ｉとの間
に［Ｒn／（１＋Ｒn ）］・ωn 2 ・（１／ｓ）の伝達
関数を有する第３の伝達要素７ｇと［Ｒn ／（１＋
Ｒn ）］・２γn ・ωn の伝達関数を有する第４の伝達
要素７ｈの並列結合を有し、第４の加え合わせ点７ｉと
出力点との間に１／（Ｒn ・ｓ）の伝達関数を有する第
５の伝達要素７ｋを有している。そして第４の加え合わ
せ点７ｉと第５の伝達要素７ｋとの間に設けられた第２
の引き出し点７ｊから第２の加え合わせ点７ｃに第２の
フィードバックループが形成された構成を有している。
ック線図について説明する。モデル電気制御部７Ａは、
補正速度指令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］が入力
される第１の加え合わせ点７ａと第２の加え合わせ点７
ｃとの間に２ζe ・ωe ＋ωe 2 （１／ｓ）の伝達関数
を有する第１の伝達要素７ｂを有している。そして第２
の伝達要素７ｄと第３の加え合わせ点７ｆとの間に設け
られた第１の引き出し点７ｅから第１の加え合わせ点７
ａに第１のフィードバックループが形成された構成を有
している。モデル機械部７Ｂは、また第２の加え合わせ
点７ｃと第３の加え合わせ点７ｆとの間に１／ｓの伝達
関数を有する第２の伝達要素７ｄを有している。また第
３の加え合わせ点７ｆと第４の加え合わせ点７ｉとの間
に［Ｒn／（１＋Ｒn ）］・ωn 2 ・（１／ｓ）の伝達
関数を有する第３の伝達要素７ｇと［Ｒn ／（１＋
Ｒn ）］・２γn ・ωn の伝達関数を有する第４の伝達
要素７ｈの並列結合を有し、第４の加え合わせ点７ｉと
出力点との間に１／（Ｒn ・ｓ）の伝達関数を有する第
５の伝達要素７ｋを有している。そして第４の加え合わ
せ点７ｉと第５の伝達要素７ｋとの間に設けられた第２
の引き出し点７ｊから第２の加え合わせ点７ｃに第２の
フィードバックループが形成された構成を有している。
【００２４】なお図２において、Ｒg は減速機の減速比
の逆数、ωｇは減速機出力軸の回転速度、ωl は被駆動
機械系の回転速度、Ｌは電機子インダクタンス、Ｒは電
機子抵抗、Ｋt はトルク定数、Ｋe は誘起電圧定数、Ｋ
c は電流ループゲイン、Ｋcbは電流フィードバックゲイ
ン、Ｊm はモータ部の慣性モーメント、Ｊg は減速機の
出力部の慣性モーメント、Ｊl は被駆動機械系の慣性モ
ーメント、Ｋg は減速機のねじり剛性、Ｃg は減速機の
等価減衰定数、Ｋs は減速機出力軸と被駆動機械系間の
ねじり剛性、Ｃs は減速機出力軸と被駆動機械系間の減
衰定数、Ｋv は速度制御系ＰＩ制御の比例ゲイン、Ｔi
は速度制御系ＰＩ制御の積分時定数である。
の逆数、ωｇは減速機出力軸の回転速度、ωl は被駆動
機械系の回転速度、Ｌは電機子インダクタンス、Ｒは電
機子抵抗、Ｋt はトルク定数、Ｋe は誘起電圧定数、Ｋ
c は電流ループゲイン、Ｋcbは電流フィードバックゲイ
ン、Ｊm はモータ部の慣性モーメント、Ｊg は減速機の
出力部の慣性モーメント、Ｊl は被駆動機械系の慣性モ
ーメント、Ｋg は減速機のねじり剛性、Ｃg は減速機の
等価減衰定数、Ｋs は減速機出力軸と被駆動機械系間の
ねじり剛性、Ｃs は減速機出力軸と被駆動機械系間の減
衰定数、Ｋv は速度制御系ＰＩ制御の比例ゲイン、Ｔi
は速度制御系ＰＩ制御の積分時定数である。
【００２５】図４は図２の実施例において、シミュレー
ションによりモータの回転速度を時間０で１０００min
-1までステップ状に立ち上げ時間０．２秒で回転速度を
０min -1までステップ状に立ち下げる速度指令ω
cmd ［図４（Ａ）］を与えた場合の応答結果を示してい
る。図４（Ｂ）はモータの回転速度ωm であり、図４
（Ｃ）は歯車減速機の出力の回転速度ωg であり、図４
（Ｄ）は負荷の速度ωl である。これらの応答結果と図
６に示した制振制御を行わなかった場合とを比較する
と、本発明によれば負荷振動系の減衰能が増加し、負荷
の残留振動の整定時間を２００ｍsec から６０ｍsec へ
と、約１／３．３に低減できることが分かる。しかも機
械系の減衰比を大きくした場合に生じる負荷の応答遅れ
も発生していない。この例で示されるように、本発明に
よれば、図面情報や実機計測データを用いて、きわめて
容易に実現可能な構成で、負荷で発生する残留振動の抑
制効果を得ることができる。
ションによりモータの回転速度を時間０で１０００min
-1までステップ状に立ち上げ時間０．２秒で回転速度を
０min -1までステップ状に立ち下げる速度指令ω
cmd ［図４（Ａ）］を与えた場合の応答結果を示してい
る。図４（Ｂ）はモータの回転速度ωm であり、図４
（Ｃ）は歯車減速機の出力の回転速度ωg であり、図４
（Ｄ）は負荷の速度ωl である。これらの応答結果と図
６に示した制振制御を行わなかった場合とを比較する
と、本発明によれば負荷振動系の減衰能が増加し、負荷
の残留振動の整定時間を２００ｍsec から６０ｍsec へ
と、約１／３．３に低減できることが分かる。しかも機
械系の減衰比を大きくした場合に生じる負荷の応答遅れ
も発生していない。この例で示されるように、本発明に
よれば、図面情報や実機計測データを用いて、きわめて
容易に実現可能な構成で、負荷で発生する残留振動の抑
制効果を得ることができる。
【００２６】
【発明の効果】本発明によれば、速度制御ループ系の電
気制御部及び機械部の低次元制御モデルを用いて、負荷
の速度を実際に検出することなくモータ軸の回転速度に
換算した負荷の回転速度を推定し、この推定した負荷の
回転速度を用いて簡単に制振制御を行える減速機構付き
サーボ制御系の制振方法を提供できる。
気制御部及び機械部の低次元制御モデルを用いて、負荷
の速度を実際に検出することなくモータ軸の回転速度に
換算した負荷の回転速度を推定し、この推定した負荷の
回転速度を用いて簡単に制振制御を行える減速機構付き
サーボ制御系の制振方法を提供できる。
【図１】 歯車減速機構を有する機械系に本発明を適用
した実施の形態の一例のブロック線図である。
した実施の形態の一例のブロック線図である。
【図２】 歯車減速機構を有する機械系に本発明を適用
した実施例のブロック線図である。
した実施例のブロック線図である。
【図３】 図１のサーボ制御系の低次元簡易モデルのブ
ロックダイアグラムである。
ロックダイアグラムである。
【図４】 （Ａ）〜（Ｄ）は本発明の効果を確認するた
めに行ったシミュレーションの結果を示す図である。
めに行ったシミュレーションの結果を示す図である。
【図５】 本発明の方法により振動を抑制する減速機構
付きサーボ制御系の一例であるドラム駆動系の概略図で
ある。
付きサーボ制御系の一例であるドラム駆動系の概略図で
ある。
【図６】 （Ａ）〜（Ｄ）は本発明を適用しない場合に
残留振動が発生することをシミュレーションした結果を
示す図である。
残留振動が発生することをシミュレーションした結果を
示す図である。
１ 負荷 ２ 減速機 ３ モータ ４ 電気制御部 ５ 速度検出器 ６ 増幅器 ７ オブザーバ ７Ａ モデル電気制御部 ７Ｂ モデル機械部 ９ 増幅器 １０１ サーボモータ １０２ ロータリエンコーダ １０３ 歯車減速機 １０４ プーリ １０５ タイミングベルト １０６ 回転ドラム １０７ 制御装置
───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.6 識別記号 ＦＩ Ｇ０５Ｄ 3/00 Ｇ０５Ｄ 3/00 Ｘ 19/02 19/02 Ｄ
Claims (6)
- 【請求項１】 モータを含む駆動部によって駆動される
被駆動機械部に減速機構を有するサーボ制御系において
負荷で発生する機械系の固有振動数と関わる低周波数域
の残留振動を抑制する減速機構付きサーボ制御系の制振
方法であって、 負荷の回転速度を前記モータ軸の回転速度に換算して推
定する関係を予め設定しておき、 推定した前記負荷の回転速度と前記モータの回転速度と
の偏差を前記残留振動を抑制するように速度指令値に加
算することを特徴とする減速機構付きサーボ制御系の制
振方法。 - 【請求項２】 減速機構を介して負荷を駆動するモータ
と、前記モータのモータ回転速度ωm を検出する速度検
出器を含んで前記モータ回転速度を帰還量とするフィー
ドバックループと、速度指令量ωcmd と前記帰還量との
偏差を入力として前記モータに操作量を与える電気制御
部とを有する減速機構付きサーボ制御系において発生す
る残留振動を、予め定めた制御モデルに基づいて推定し
た前記負荷の推定負荷回転速度を用いて抑制する減速機
構付きサーボ制御系の制振方法であって、 前記推定負荷回転速度ωlmを前記モータ軸の回転速度に
換算して推定し、 前記モータ回転速度ωm と前記推定負荷回転速度ωlmと
の偏差（ωlm−ωm ）を求め、 前記偏差に前記残留振動を抑制するのに適したゲインＫ
ｂを乗じて補正値Ｋｂ（ωlm−ωm ）を求め、 前記補正値Ｋｂ（ωlm−ωm ）を速度指令量ωcmd に加
算して得た補正速度指令量［ωcmd ＋Ｋｂ（ωlm−
ωm ）］を前記電気制御部への速度指令量ω´cmdとす
ることにより前記残留振動を抑制することを特徴とする
減速機構付きサーボ制御系の制振方法。 - 【請求項３】 前記制御モデルは、前記補正速度指令量
［ωcmd ＋Ｋｂ（ωlm−ωm ）］から前記推定負荷回転
速度ωlmを推定するようにモデル化されたモデル電気制
御部及び前記モータと前記減速機構と前記負荷とを含む
モデル化されたモデル機械部とからなり、前記モデル電
気制御部はその固有振動数ωe と減衰比ζe とを用いて
予めモデル化されており、前記モデル機械部はその固有
振動数ωn と減衰比γn と慣性モーメント比Ｒn とを用
いて予めモデル化されていることを特徴とする請求項２
に記載の減速機構付きサーボ制御系の制振方法。 - 【請求項４】 前記モデル電気制御部は、前記補正速度
指令量［ωcmd ＋Ｋｂ（ωlm−ωm ）］が入力される第
１の加え合わせ点と第２の加え合わせ点との間に２ζe
・ωe ＋ωe 2 （１／ｓ）の伝達関数を有する第１の伝
達要素を有しており、また第２の伝達要素と第３の加え
合わせ点との間に設けられた第１の引き出し点から前記
第１の加え合わせ点に第１のフィードバックループが形
成された構成を有しており、 前記モデル機械部は、前記第２の加え合わせ点と前記第
３の加え合わせ点との間に１／ｓの伝達関数を有する第
２の伝達要素を有し、前記第３の加え合わせ点と第４の
加え合わせ点との間に［Ｒn ／（１＋Ｒn ）］・ωn 2
・（１／ｓ）の伝達関数を有する第３の伝達要素と［Ｒ
n ／（１＋Ｒn ）］・２γn ・ωn の伝達関数を有する
第４の伝達要素の並列結合を有し、前記第４の加え合わ
せ点と出力点との間に１／（Ｒn ・ｓ）の伝達関数を有
する第５の伝達要素を有し、前記第４の加え合わせ点と
第５の伝達要素との間に設けられた第２の引き出し点か
ら前記第２の加え合わせ点に第２のフィードバックルー
プが形成された構成を有している請求項３に記載の減速
機構付きサーボ制御系の制振方法。 - 【請求項５】 前記モデル電気制御部の前記固有振動数
ωe は［（Ｋvm・Ｋtm）／（Ｔim・Ｊmm）］1/2 と表さ
れ、前記減衰比ζe は（１／２）［（Ｔim・Ｋvm・
Ｋtm）／Ｊmm］1/2 と表され、但しＫvmはＰＩ制御の速
度ループゲインであり、ＴimはＰＩ制御の積分時定数で
あり、Ｋtmはトルク定数であり、Ｊmmはモータ軸に換算
したモータ側の慣性モーメントであり、 また前記モデル機械部の固有振動数ωn は｛Ｋsm［（１
／Ｊmm）＋（１／Ｊlm）］｝1/2 と表され、減衰比γn
は｛Ｃsm［（１／Ｊmm）＋（１／Ｊlm）］｝／２ωn と
表され、但しＫsmはモータ軸に換算したねじりばね剛性
であり、Ｊlmはモータ軸に換算した負荷側の慣性モーメ
ントであり、Ｃsmはモータ軸に換算した減衰定数であ
り、 前記Ｋvm，Ｋtm，Ｔim，Ｊmm，Ｋsm，Ｊlm，Ｃsmを図面
情報より求めることを特徴とする請求項３に記載の減速
機構付きサーボ制御系の制振方法。 - 【請求項６】 前記Ｋvm，Ｋtm，Ｔim、を図面情報より
求め、 慣性モーメント比Ｒn ＝Ｊlm／Ｊmmと定義して、前記Ｊ
lm＝Ｒn ・Ｊmm、前記Ｋsm＝ωn 2 ・［（Ｒn ・Ｊmm）
／（１＋Ｒn ）］、前記Ｃsm＝［（２Ｒn ・Ｊmm）／
（１＋Ｒn ）］・γn ・ωn と表し、前記Ｒn ，Ｊmm，
ωn ，γn を実運転データから求めることを特徴とする
請求項３に記載の減速機構付きサーボ制御系の制振方
法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP18847897A JP3364412B2 (ja) | 1997-07-14 | 1997-07-14 | 減速機構付きサーボ制御系の制振方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP18847897A JP3364412B2 (ja) | 1997-07-14 | 1997-07-14 | 減速機構付きサーボ制御系の制振方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH1131015A true JPH1131015A (ja) | 1999-02-02 |
| JP3364412B2 JP3364412B2 (ja) | 2003-01-08 |
Family
ID=16224439
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP18847897A Expired - Fee Related JP3364412B2 (ja) | 1997-07-14 | 1997-07-14 | 減速機構付きサーボ制御系の制振方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3364412B2 (ja) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6533058B2 (en) * | 2000-08-08 | 2003-03-18 | Trw Automotive Electronics & Components Gmbh & Co. Kg | Drive for a flap on a vehicle and a pedestrian protection means on a motor vehicle |
| JP2008035613A (ja) * | 2006-07-28 | 2008-02-14 | Kayaba Ind Co Ltd | 駆動系およびアクチュエータ |
| JP2011172317A (ja) * | 2010-02-16 | 2011-09-01 | Sanyo Denki Co Ltd | モータ制御装置 |
-
1997
- 1997-07-14 JP JP18847897A patent/JP3364412B2/ja not_active Expired - Fee Related
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6533058B2 (en) * | 2000-08-08 | 2003-03-18 | Trw Automotive Electronics & Components Gmbh & Co. Kg | Drive for a flap on a vehicle and a pedestrian protection means on a motor vehicle |
| JP2008035613A (ja) * | 2006-07-28 | 2008-02-14 | Kayaba Ind Co Ltd | 駆動系およびアクチュエータ |
| JP2011172317A (ja) * | 2010-02-16 | 2011-09-01 | Sanyo Denki Co Ltd | モータ制御装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3364412B2 (ja) | 2003-01-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3506157B2 (ja) | 電動機の位置制御装置 | |
| JP2003009566A (ja) | 電動モータを用いた車両の制振制御装置 | |
| JP4367058B2 (ja) | モータ制御装置 | |
| JPH10275003A (ja) | ２慣性共振系を制御する方法及びその装置 | |
| JP4914979B2 (ja) | モータ制御装置およびモータ制御方法 | |
| JPH10329063A (ja) | ロボット制御装置 | |
| KR19980083174A (ko) | 공진계의 진동억제 제어방법 및 제어장치 | |
| JP5234774B2 (ja) | シャシーダイナモ制御装置 | |
| JPH09212203A (ja) | ロボット制御装置 | |
| JPH1131015A (ja) | 減速機構付きサーボ制御系の制振方法 | |
| JPH10217173A (ja) | ロボットの非干渉化制御装置 | |
| JP3336791B2 (ja) | モータ負荷特性同定装置 | |
| JP3220589B2 (ja) | メカニカルシステムの制御装置 | |
| JP2964736B2 (ja) | 二慣性系における結合軸の機械時定数同定方法 | |
| JP3246572B2 (ja) | 電動機駆動系の負荷定数測定方法 | |
| JPH08278821A (ja) | サーボ制御系の制振方法 | |
| JPH106261A (ja) | ロボット制御装置 | |
| JP2767637B2 (ja) | 電動式パワー・ステアリング装置 | |
| JP3171860B2 (ja) | サーボ制御システム | |
| JP4220366B2 (ja) | 捩り振動系制御装置 | |
| JP2006074896A (ja) | モータ制御装置 | |
| Nagao et al. | Robust Torsion Torque Control using Single Inertialization Compensator for Two-inertia System with Environmental Stiffness | |
| JP5444929B2 (ja) | シャシーダイナモメータシステム | |
| US5532566A (en) | Voltage mode drive of servo system | |
| JP4565426B2 (ja) | モータ制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20020924 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |