JP3055186B2 - 電動機の瞬時位置・瞬時速度・瞬時加速度検出装置、ならびに瞬時位置値・瞬時速度値・瞬時加速度値を用いた電動機の制御方法 - Google Patents
電動機の瞬時位置・瞬時速度・瞬時加速度検出装置、ならびに瞬時位置値・瞬時速度値・瞬時加速度値を用いた電動機の制御方法Info
- Publication number
- JP3055186B2 JP3055186B2 JP03033015A JP3301591A JP3055186B2 JP 3055186 B2 JP3055186 B2 JP 3055186B2 JP 03033015 A JP03033015 A JP 03033015A JP 3301591 A JP3301591 A JP 3301591A JP 3055186 B2 JP3055186 B2 JP 3055186B2
- Authority
- JP
- Japan
- Prior art keywords
- motor
- instantaneous
- pulse
- sampling timing
- state
- 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
Landscapes
- Control Of Electric Motors In General (AREA)
Description
センサとしてパルスエンコーダ、ロータリエンコーダ或
いはパルスジェネレータ等のパルス発生手段を用いた電
動機制御における電動機の位置(回転角)の瞬時値、速
度及び加速度の検出装置、ならびに瞬時位置値・瞬時速
度値・瞬時加速度値を用いた電動機の制御方法に関す
る。
エレクトロニクスを利用した電動機の可変速駆動分野に
おいては、制御の高性能化、高信頼化、高機能化への要
求からマイクロコンピュータを適用したディジタル制御
方式の採用が盛んである。
度の速度検出、加速度検出或いは位置(回転角)検出を
行う必要があり、いわゆるパルスジェネレータ、パルス
エンコーダ或いはロータリエンコーダ(以下、エンコー
ダと呼ぶ)を用いて、電動機の位置(回転角)が直接検
出され、更に、その検出値を用いて周波数という物理量
を求めることにより電動機の速度、加速度の検出が行わ
れている。
方法においては、図9に示されるように、エンコーダ
が、本来連続量である回転角θを、エンコーダの分解能
で規定される極めて荒い離散値である積算値θn として
出力する。このため、任意のサンプリングタイミングt
(例えば図9のt1 )における検出値θn において、マ
クロ的には検出の遅れ(例えば図9の無駄時間Δt1 )
が発生し、ミクロ的には真の回転角に対してエンコーダ
分解能で最大1量子化幅分の量子化誤差が発生する(例
えば図9の「θ(t1 )−θ(t1 −Δt1 )」)。従
って、例えばエンコーダ出力を用いて回転角或いは位置
の制御を行う場合に、これらの検出遅れや量子化誤差の
ために制御の応答が劣化したり、安定性や制御精度が損
われるという問題点を有している。
方法としては、一定期間内にエンコーダが発生するパ
ルス数を計数し、それを計数した期間(時間)で割る方
法、エンコーダが発生するパルスとパルスの間隔(周
期)を計測し、その逆数をとって速度とする方法等があ
る。このほかにも、例えば「特開昭58-48868号」に開示
される方法では、一定サンプリング期間内のパルス数と
そのパルスが発生するのに要した正味の時間が計測さ
れ、それでパルス数が除されることによって、高精度な
速度検出が実現されている。しかし、これらの方法で得
られる速度検出値はいずれも各々の計測期間内における
平均速度を計測した結果として得られる値であって、従
来の速度発電機を用いた速度検出に比べて、その検出値
には時間平均による遅れが含まれることになり、これが
制御系の応答や安定性に関して種々の悪影響を生ぜしめ
てしまうという問題点を有している。
58-48868号」に開示されている方法で検出した平均速度
に加えて、状態観測器論理に基づいて推定された負荷外
乱トルク及び電動機の出力トルクとからサンプリング時
点における瞬時速度を演算して求めるようにしている。
この方法では、一旦、平均速度が求められてから瞬時速
度が計算される。しかし、速度センサとしてパルスジェ
ネレータの出力パルスを計数することはその計数期間内
における電動機軸の回転角度を計測していることであっ
て、それを時間で除して得られる速度は文字通り平均速
度であり、電動機の過渡現象を記述する状態方程式の中
に現れる電動機速度ωとは似て非なるものである。言い
換えれば平均速度は現象を表現する上の概念のひとつで
あって、現実の物理現象、特に過渡現象を記述するのに
は必ずしも適切ではない。例えば、加速過程にある場合
と減速過程にある場合では、平均速度が等しくともその
物理現象(一例として、時間平均期間の始点と終点にお
ける瞬時速度)は全く異なったものであり、そのような
平均速度から将来の瞬時速度を演算することにはおのず
から限界がある。
においては、従来の主流であった電流制御系をマイナー
ループにもつ速度制御系に代わって、加速度という状態
量に着目した加速度制御系を構成する方式が学会論文等
(例えば、堀:「加速度制御形サーボ系の提案」電気学
会論文誌D,107 昭和62-12)で発表されている。この場
合、加速度を検出する方式として速度発電機(タコジェ
ネレータ)の出力をアナログ信号の形で微分するのが最
も一般的ではあるが、微分動作がノイズに対して敏感で
あることから純粋な微分動作を適用することは困難であ
る。このため、実際には、速度がアナログ回路で不完全
微分されたものが加速度として使用される。或いは、制
御系がディジタルシステムで構成される場合には、ソフ
トウェアによる演算処理で加速度が算出される場合もあ
る。しかし、これらの方法では、理想的な加速度量を得
ることが困難で、また得られた加速度に遅れが含まれる
という問題点を有している。特にパルスジェネレータを
使用して速度検出を行う場合に加速度を直接検出するこ
とは事実上不可能である。
ィジタル制御系においては、電動機制御に現代制御理論
のひとつである状態観測器理論を適用した方法として、
電動機の負荷外乱トルクを状態観測器(オブザーバ)に
より推定する方法がある。この状態観測器では、電動機
の電気〜機械系のモデルの入力として、例えば電動機の
出力トルク実際値或いは電力変換器へのトルク指令値が
用いられている。これらの使い分けとしては、主として
現実に電動機を動力学的に駆動しているトルク実際値を
使って状態観測器内のモデルを駆動することが第1とさ
れ、交流電動機の駆動装置の場合のようにトルク実際値
が直接検出できない場合や検出できる場合でも検出値に
大きなリプル等が含まれているために制御系の外乱にな
る場合、或いはトランジスタインバータのように電流制
御系の応答が速いために指令値を実際値とみなしえるよ
うな場合には、電力変換器へのトルク指令値の瞬時値又
は平均値が状態観測器の入力として用いられている。し
かし、この方法では、電気系→機械系へのダイナミクス
が考慮されないという問題点を有している。
ィジタル制御系では、制御対象の状態量の検出、制御演
算等が時系列に行われるために、検出から制御までの無
駄時間が存在し、検出値に含まれる遅れ(図9参照)と
もあいまって制御性能を損なったり、或いは充分な制御
性能を発揮しえないという問題点を有している。
置(回転角)、瞬時速度及び瞬時加速度の演算を可能と
して、制御系の応答改善を図ることを目的とする。
付けられたパルスエンコーダ、ロータリエンコーダ或い
はパルスジェネレータ等のパルス発生手段からのパルス
に基づいて電動機の位置又は回転角を検出する位置検出
手段を有する電動機の制御装置を前提とする。同手段
は、例えばエンコーダパルスをカウントするカウンタで
あり、同カウンタは、例えばサンプリングタイミング毎
にリセットされて、各サンプリング周期におけるエンコ
ーダパルスの積算値を演算する。
明のブロック図である。時間差計測手段107は、サン
プリングタイミング毎に、その直前のパルス発生手段か
らのパルスの発生時点から当該サンプリングタイミング
までの時間差108を計測する。
102、位置又は回転角103及び負荷外乱トルク10
4の3変数を状態変数106とし、システム入力を電動
機トルク105、システム出力を位置又は回転角103
とした状態方程式に対して、サンプリングタイミング毎
に、時間差計測手段107によって計測された時間差1
08に基づいて、その直前のパルス発生手段からのパル
スの発生時点における状態変数106を推定する。この
推定は、前回のサンプリングタイミング時に推定された
状態変数に基づいて行われる。
タイミング毎に、状態観測手段101により推定された
状態変数106及び時間差計測手段107によって計測
された時間差108から状態方程式に基づいて、当該サ
ンプリングタイミングにおける電動機の位置又は回転角
の瞬時値114を演算する。この場合の演算は、状態方
程式から導出される遷移行列から求まる式によって行わ
れる。
に、当該サンプリングタイミングにおける電動機の速度
の瞬時値110を演算する瞬時速度演算手段109を有
するように構成することもできる。
グタイミングにおける電動機の加速度の瞬時値112を
演算する瞬時加速度演算手段111を有するように構成
することもできる。
演算手段109又は瞬時加速度演算手段111を任意に
組み合わせることもできる。次に、本発明の第2の態様
について説明する。第2の態様では、上述の第1の態様
における状態変数106として、前述の電動機の回転速
度102、位置又は回転角103及び負荷外乱トルク1
04の3変数に、更に電動機トルクを加えた4変数が使
用される。そして、システムの出力は、第1の態様と同
じく位置又は回転角103とされるが、システムの入力
が電動機トルクの指令値とされる点が異なる。
る。第3の態様では、上述の本発明の第1の態様又は第
2の態様において、瞬時速度演算手段又は瞬時加速度演
算手段は、各サンプリングタイミングの時点ではなく、
それより更に制御演算等に要する時間に相当する所定時
間だけ遅れた時点における位置若しくは回転角、速度又
は加速度の瞬時値を演算する構成とされる。
してパルスエンコーダ等のパスル発生手段を用いた電動
機の制御システムにおいて、パルス発生手段の動作が電
動機の回転角をきわめて分解能の粗い量子化された情報
として出力するが、パルス発生手段からのパルスの発生
時点においてはその出力回転角情報と実際の電動機の回
転角が一致するという点に着目し、パルス発生手段から
のパルスの発生時点における電動機の状態方程式を構築
したことにより、当該パルス発生時点におけるシステム
の状態変数(瞬時値)を実際の物理現象により則した状
態観測器によって推定し、そこから上記パルスの発生時
点とは非同期のサンプリングタイミングにおける瞬時位
置若しくは回転角、瞬時速度を推定するので、検出のた
めの無駄時間を含まないより正確な瞬時値が得られる。
の積算値をそのまま使用した場合の位置又は回転角の検
出分解能がパルス発生手段の分解能そのままのいわば整
数値であったのに対して、本発明により得られるサンプ
リングタイミング毎の位置又は回転角の瞬時値は、推定
演算の精度を別にすれば、みかけ上は小数点以下を含ん
だ連続量として得ることができる。このため、従来のよ
うなパルス発生手段の分解能に起因する量子化誤差の影
響を受けない。
態変数から演算で求めることから、微分動作にかかわる
問題点を回避できるとともに、遅れのない瞬時加速度を
得ることができる。
に要する無駄時間だけ遅延させた時点の瞬時値を演算し
これを制御演算で使用することにより、検出・制御演算
等の無駄時間に起因する制御系の応答改善を図ることが
できる。
つき説明する。まず、具体的な実施例につき説明する前
に、本発明の原理的な実施例の構成及び動作原理につき
説明する。
構成図である。同図に表される系からわかるように、第
1の原理構成では、電動機の速度ω、負荷外乱トルクτ
d 及びエンコーダの出力パルス積算値に換算した電動機
の回転角θが状態変数ベクトルχ1 とされる。そして、
システムの入力として電動機トルクτM 、システムの出
力として電動機の回転角θを選んだ後述する下記の数1
式の(1) 式、(2) 式で表される状態方程式に基づいて、
後述する図4のタイミングチャートにおけるサンプリン
グタイミングt=t1 の直前のエンコーダパルス発生時
点(t=t1−Δt1 )における上記状態変数ベクトル
の推定値 外1 (以下、文章中におい
式の(3)式で示される状態観測器アルゴリズムを用いて
演算される。つぎに、サンプリングタイミングt=t1
における電動機の回転角(位置)θの瞬時値が、数1式
の(1) 式の状態方程式から導出される遷移行列Φによっ
て構成される下記の数2式の(4) 式に上記状態変数の推
定値χ1'が適用されて演算によって求められる。また、
サンプリングタイミングt=t1 における電動機の速度
ωの瞬時値が、上記状態変数の推定値χ1'から下記の数
2式の(5) 式で表される代数演算によって求められる。
更に、電動機の加速度dω/dtの瞬時値が、上記推定
値χ1'から下記の数2式の(6a),(6b) 式で表される代数
演算によって求められる。
する。今、電動機の回転角センサとしてのエンコーダパ
ルスの積算値θn は、図9において前述したように、エ
ンコーダの分解能で規定される量子化により、真の回転
角θに対して、下式(7) にて表される量子化誤差を含ん
でいる。
幅分の誤差が含まれていることになる。従って、これを
そのまま使用すると正しい位置(回転角)検出は行うこ
とができない。また、エンコーダの出力に基づいて周波
数情報が演算され速度検出が行われる場合には、その演
算により得られる速度量は、時間積分を時間でわったも
の即ち平均値でしかなく、正しい速度検出、更には加速
度検出も行えない。
生するというエンコーダ本来の動作は積分動作であっ
て、そこから得られるエンコーダ出力パルスの積算値θ
n は、図9から明らかなように、エンコーダパルスの発
生時点(例えば図9のt=t1 −Δt1 )において、量
子化誤差やエンコーダの分解能に関係なく真の回転角θ
という実際の物理量と完全に一致する。そして、その時
点における積算値θn の微分が電動機速度にほかならな
い。このような事実に着目して、従来から用いられてき
た速度或いは平均速度の代わりに、エンコーダパルスの
入力時点における電動機の回転角をシステムを記述する
状態方程式の出力として考えると、数1式の(1),(2) 式
の状態方程式で表されるような関係が成立する。換言す
れば、エンコーダパルスの入力時点であれば、直接検出
可能で確実な情報であるエンコーダパルスの積算値θn
を用いて、次に説明する状態観測器に関する制御理論に
基づいて、状態変数ベクトルχ1 を推定することができ
る。ここで「確実な」とは、回転角(位置)θ以外の他
の状態変数例えば回転速度ωをパルスエンコーダを用い
て計測した値は、エンコーダパルスの積算値θn を時間
で除したもの即ち平均速度にほかならず、状態方程式
(1),(2) 式に現れる速度ωとは必ずしも等価な状態量で
はないのに対して、エンコーダパルスの入力時点であれ
ばエンコーダパルスの積算値θn は状態方程式(1),(2)
式に現れる出力θと厳密に一致するという意味である。
ば、システムの出力y1 から状態変数ベクトルχ1 を推
定することが可能であり、また、任意の時刻の状態から
その後の状態を演繹的に算出することができる。そこ
で、(1),(2) 式の可観測性を検証する。
が可観測であることの必要十分条件は、下記の数3式で
ある(8) 式で定義される行列N1 の階数(rank) が行列
A1 (数1式参照)の次数(この場合、3)と等しいこ
と、であることが知られている。
表されるシステムは可観測であり、係数行列K1 を適当
に選ぶことで、数2式の(3) 式に基づき、状態変数ベク
トルχ1 を任意の応答で推定することができる。そこ
で、図4のタイミングチャートのt=t1 で示されるサ
ンプリングタイミングで、エンコーダのパルス数に換算
した数1式の(1) 式の状態方程式における電動機の回転
角θのt=t0 −Δt0 〜t=t1 −Δt1 間における
変化分Δθ(必ずしも整数にはならないし、ならなくと
もよい)と、今回のサンプリングタイミングt=t0 〜
t1 までの間に発生したエンコーダパルスの積算値θn
(言うまでもなくθn は整数であり、状態変数の差Δθ
に対するシステムの出力である)との差に基づいて、t
=t1 −Δt1 の時点における状態変数の推定値χ1'が
演算される。
数の推定値χ1'から、t=t1 における状態変数の推定
値χ1'が下記の数4式の(9) 式に基づいて演算される。
(4) 式が得られ、これによりt=t1 における瞬時位置
(回転角の瞬時値)θが得られる。なお、(9) 式は、t
=t1 −Δt1 〜t1 でτM が一定とした場合のもので
ある。
得られ、これによって、t=t1 における瞬時速度ωが
得られる(τMは上述のように仮定)。更に、(9) 式よ
り前述の数2式の(6a)式が得られ、これによって、t=
t1 におけるτd の瞬時値が計算され(τM は上述のよ
うに仮定)、数1式の(1) 式の状態方程式の一部である
前述の数2式の(6b) 式により、t=t1 における加速
度dω/dtt=t1を求めることができる。
変数)から数4式の(9) 式によってそれ以後の状態を求
める方法は公知であって、例えば古田・佐野著「基礎シ
ステム理論」(コロナ社)等に詳しい。
の原理構成図である。同図に表される系からわかるよう
に、第2の原理構成では、上述の第1の原理構成で示し
た状態変数ベクトルχ1 の構成要素に電動機トルクτM
が加えられている。そして、システムの入力を電動機ト
ルクτM の代わりにその制御装置のトルク指令値τ* と
して、下記の数5式の(10)式、(11) 式で表される状態
方程式が仮定され、第1の原理構成の場合と同様な演算
が行われることによって、サンプリング時点における電
動機回転角(位置)θ、速度ω及び加速度dω/dtの
瞬時値が求められる。即ち、下記の数6式の(12)式で表
される状態観測器アルゴリズムに基づき、サンプリング
タイミングt=t1 直前のエンコーダパルス発生時点
(t=t1 −Δt1 )における上記状態変数ベクトルの
推定値 外2 (以下、文章中では
に、サンプリングタイミングt=t1 における電動機の
回転角(位置)θの瞬時値が、数6式の(13)式に上記状
態変数の推定値χ2'が適用されて演算によって求められ
る。また、サンプリングタイミングt=t1 における電
動機の速度ωの瞬時値が、上記状態変数の推定値χ2'か
ら下記の数6式の(14)式で表される代数演算によって求
められる。更に電動機の加速度dω/dtの瞬時値が、
サンプリングタイミングt=t1 における状態変数ベク
トルχ2 の推定値χ2'から数6式の(15a),(15b),(15c)
式で表される代数演算によって求められる。
2の原理構成における状態方程式についても、第1の原
理構成の場合と同様、これらが可観測であれば、システ
ムの出力y2 から状態変数ベクトルχ2 を推定すること
が可能であり、また、任意の時刻の状態からその後の状
態を演繹的に算出できる。そこで、(10),(11) 式の可観
測性についても、数3式の(8) 式と同様にして検証を行
うと、次の(16)式のようになる。
式で表される第2の原理構成におけるシステムについて
も可観測であり、状態観測器による状態変数の推定及び
任意時点の状態変数からその後の状態変数を演繹的に演
算することができる。即ち、t=t1 における状態変数
ベクトルχ2 の推定値χ2'は次の数8式の(17),(18)式
にて求めることができる。
a),(15b) 式が得られ、t=t1 におけるτM ,τd の
瞬時値が計算されるとともに、t=t1 における瞬時位
置(回転角)θ及び瞬時速度ωが求まる。
5式の(10)式の状態方程式の一部である前述の数6式の
(15c) 式によって、t=t1 における加速度dω/dt
t=t1を求めることができる。
明する。第3の原理構成については特には図示しない
が、上述の第1の原理構成又は第2の原理構成の拡張と
して構成される。
の原理構成において、エンコーダのパルス発生時点にお
ける状態変数ベクトルの推定値から演算する瞬時位置
(回転角)・瞬時速度・瞬時加速度の時刻が、サンプリ
ング周期の開始時点即ちサンプリングタイミングt=t
1 とされずに、各瞬時値の検出演算及びその演算に基づ
くシステムの制御演算等に要する時間Δtc だけ遅延さ
せられた時点t=t1 +Δtc とされ(図4参照)、そ
の時点での各々の瞬時値が演算されてシステムの制御演
算に使用される。これが第3の原理構成の特徴である。
アルゴリズムでは、計測(サンプリング)周期内の最後
のエンコーダパルス発生時点の状態変数の推定値から、
その直後のサンプリング周期の開始時点における瞬時値
が、その状態方程式に基づいて予測演算された。しかる
に、その予測する時点を、サンプリング周期の開始時点
とせずに、各種検出演算、制御演算等の所要時間だけ遅
らせた時点としても、その瞬時値を同様に演算すること
ができる。そこで、第3の原理構成ではこれを利用し
て、制御系に存在する無駄時間がキャンセルされるよう
に、サンプリングタイミングより遅らせた時点の瞬時位
置(回転角)、瞬時速度、瞬時加速度を演算して利用す
ることによって、これらの無駄時間に起因する制御の応
答改善を図ることを可能としている。
明の実施例の具体的構成について詳細に説明する。図5
に本発明の具体的な実施例の構成図、図4にその動作タ
イミングチャートを示す。
検出用のエンコーダの2相パルスA、Bは、位相判別回
路501において、電動機の回転方向によって決まる上
記2相パルスの位相に応じて、後段のアップダウンカウ
ンタ502へのアップカウント信号Pup又はダウンカウ
ント信号Pdownに変換される。
プカウント信号Pup、ダウンカウンタ信号Pdownによっ
て、エンコーダパルスを、正転方向をプラス、逆転方向
をマイナスとして積算し、同カウンタは、一定周期Ts
で発生されるサンプリングタイミング信号Sによって0
にリセットされる。
のシステムクロックFをカウントすることにより、シス
テムクロックに換算した時間計測器として機能し、アッ
プカウント信号Pup、ダウンカウント信号Pdownの論理
和信号によって0にリセットされる。
れサンプリングタイミング信号Sによって同信号でリセ
ットされる直前のアップダウンカウンタ502の積算値
θn及び時間計測用カウンタ503のカウント値Δtを
ラッチする。
ングタイミング信号Sによって一定周期Tsで起動され
るプログラムにおいて、データバス507を介してデー
タラッチ504及び505に保持されたエンコーダパル
スの積算値θn及び時間計測用カウンタ503のカウン
ト値Δtを読み込んで、後述のようなアルゴリズムによ
って瞬時位置(回転角)、瞬時速度、瞬時加速度等の検
出演算及び制御演算を行う。
変換器やその制御アルゴリズム等については、本発明の
直接の対象とするものでないことからここでは簡単のた
め図示や説明を省略してある。
イクロコンピュータ506が実行する第1の処理動作例
について、図6のプログラムのフローチャートにより説
明する。この処理動作は、前述の本発明の第1の原理動
作に対応している。
イクロコンピュータ506が起動した図6のフローチャ
ートで表されるプログラムにおいて、以下の各ステップ
の処理が順次実行される。
持されたエンコーダパルスの積算値θn 及び時間計測用
カウンタ3のカウント値Δt1 が読み込まれる(ステッ
プS1 )。
コーダパルス入力時点から今回サンプリングタイミング
直前のエンコーダパルス入力時点までの正味の時間tw
が、データラッチ505に保持される時間計測用カウン
タ503のカウント値の前回値Δt0 と今回値Δt1 か
ら下記(19)式により求められる(ステップS2)。
推定値χ1'とエンコーダのパルスカウント数θn 及びス
テップS2にて求められたtw 等から、今回t=t1 −Δ
t1 における状態変数ベクトルの推定値χ1'が数2式の
(3) 式に基づいて推定される(ステップS3)。
テップS3にて推定された状態変数ベクトルχ1'(t1 −
Δt1 )を用いて、今回サンプリングタイミングt=t
1 における瞬時位置(回転角)θ、瞬時速度ω、瞬時加
速度dω/dtが計算される(ステップS4)。
する第2の処理動作例について、図7のプログラムのフ
ローチャートにより説明する。この処理動作は、前述の
本発明の第2の原理構成に対応している。
イクロコンピュータ506が起動した図7のフローチャ
ートで表されるプログラムにおいて、以下の各ステップ
の処理が順次実行される。
たエンコーダパルスの積算値θn 及び時間計測用カウン
タ503のカウント値Δt1 が、それぞれ読み込まれる
(ステップS5)。
ーダパルス入力時点から今回サンプリングタイミングの
直前のエンコーダパルス入力時点までの正味の時間tw
が、データラッチ505に保持される時間計測用カウン
タ503のカウント値の前回値Δt0 と今回値Δt1 か
ら前述の(19)式により求められる(ステップS6)。
数ベクトルの推定値χ2'とエンコーダのパルスカウント
数θn 及びステップS6において求められたtw 等から、
今回t=t1 −Δt1 における状態変数ベクトルの推定
値χ2'が数6式の(12)式に基づいて推定される(ステッ
プS7)。
づいて、上記ステップS7にて推定された状態変数ベクト
ルχ2'(t1 −Δt1 )を用いて、今回サンプリングタ
イミングt=t1 における瞬時位置(回転角)θ、瞬時
速度ω及び瞬時加速度dω/dtが計算される。
行する第3の処理動作例について、図8のプログラムの
フローチャートにより説明する。この処理動作は、前述
の本発明の第3の原理構成に対応している。
イクロコンピュータ506が起動した図8のフローチャ
ートで表されるプログラムにおいて、以下の各ステップ
の処理が順次実行される。
たエンコーダパルスの積算値θn 及び時間計測用カウン
タ503のカウント値Δt1 が、それぞれ読み込まれる
(ステップS9)。
ーダパルス入力時点から今回サンプリングタイミングの
直前のエンコーダパルス入力時点までの正味の時間tw
が、データラッチ505に保持される時間計測用カウン
タ503のカウント値の前回値Δt0 と今回値Δt1 か
ら、前述の(19)式によって求められる(ステップ
S10)。
数ベクトルの推定値χ1'又はχ2'とエンコーダのパルス
カウント数θn 及びステップS10 にて求めたtw 等か
ら、今回t=t1 −Δt1 における状態変数ベクトルの
推定値χ1'又はχ2'が、数2式の(3) 式又は数6式の(1
2)式に基づいて推定される(ステップS11 )。
a),(15b),(15c) 式に基づき、上記ステップS11 におい
て推定されたt=t1 −Δt1 における状態変数ベクト
ルχ1'(t1 −Δt1 )又はχ2'(t1 −Δt1 )を用
いて、下記(20)式で示されるΔt' だけ遅延された時
点、即ち、t=t1 +Δtc における瞬時位置(回転
角)θ、瞬時速度ω及び瞬時加速度dω/dtが計算さ
れる(ステップS12 )。
間 上記ステップS12 で求められたt=t1 +Δtc におけ
る瞬時位置(回転角)θ、瞬時速度ω、瞬時加速度dω
/dtを用いて制御演算が実行される。
第1〜第3の原理構成に基づく本発明の特徴的動作が実
現される。
用センサとしてパルスエンコーダ等のパルス発生手段を
用いた電動機の制御システムにおいて、パルス発生手段
の動作が電動機の回転角をきわめて分解能の粗い量子化
された情報として出力するが、パルス発生手段からのパ
ルスの発生時点においてはその出力回転角情報と実際の
電動機の回転角が一致するという点に着目し、当該パル
ス発生時点における電動機の状態方程式を構築したこと
により、上記パルス発生時点におけるシステムの状態変
数(瞬時値)を実際の物理現象により則した状態観測器
によって推定し、そこから上記パルスの発生時点とは非
同期のサンプリングタイミングにおける瞬時位置若しく
は回転角、瞬時速度を推定するので、検出のための無駄
時間を含まないより正確な瞬時値を得ることが可能とな
る。
の積算値をそのまま使用した場合の検出分解能がパルス
発生手段の分解能そのままのいわば整数値であったのに
対して、本発明により得られるサンプリングタイミング
毎の瞬時値は、推定演算の精度を別にすれば、みかけ上
は小数点以下を含んだ連続量として得ることができる。
このため、従来のようなパルス発生手段の分解能に起因
する量子化誤差の影響を受けないという効果を有する。
態変数から演算で求めることから、微分動作にかかわる
問題点を回避できるとともに、遅れのない瞬時加速度を
得ることが可能となる。
に要する無駄時間だけ遅延させた時点の瞬時値を演算し
これを制御演算で使用することにより、検出・制御演算
等の無駄時間に起因する制御系の応答改善を図ることが
可能となる。
図である。
である。
である。
である。
Claims (14)
- 【請求項1】 電動機に取り付けられたパルス発生手段
からのパルスに基づいて電動機の位置又は回転角を検出
する位置検出手段を有する電動機の制御装置において、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差(108)を計測する時間差計測手
段(107)と、 電動機の回転速度(102)、位置又は回転角(10
3)及び負荷外乱トルク(104)の3変数を状態変数
(106)とし、システム入力を電動機トルク(10
5)、システム出力を前記位置又は回転角(103)と
した状態方程式に対して、前記サンプリングタイミング
毎に、その直前の前記パルス発生手段からのパルスの発
生時点における前記状態変数(106)を推定する状態
観測手段(101)と、 前記サンプリングタイミング毎に、前記状態観測手段
(101)により推定された状態変数(106)及び前
記時間差計測手段(107)によって計測された時間差
(108)から前記状態方程式に基づいて、該サンプリ
ングタイミングにおける電動機の位置又は回転角の瞬時
値(114)を演算する瞬時位置演算手段(113)
と、 を有することを特徴とする電動機の瞬時位置検出装置。 - 【請求項2】 電動機に取り付けられたパルス発生手段
からのパルスに基づいて電動機の位置又は回転角を検出
する位置検出手段を有する電動機の制御装置において、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差(108)を計測する時間差計測手
段(107)と、 電動機の回転速度(102)、位置又は回転角(10
3)及び負荷外乱トルク(104)の3変数を状態変数
(106)とし、システム入力を電動機トルク(10
5)、システム出力を前記位置又は回転角(103)と
した状態方程式に対して、前記サンプリングタイミング
毎に、その直前の前記パルス発生手段からのパルスの発
生時点における前記状態変数(106)を推定する状態
観測手段(101)と、 前記サンプリングタイミング毎に、前記状態観測手段
(101)により推定された状態変数(106)及び前
記時間差計測手段(107)によって計測された時間差
(108)から前記状態方程式に基づいて、該サンプリ
ングタイミングにおける電動機の速度の瞬時値(11
0)を演算する瞬時速度演算手段(109)と、 を有することを特徴とする電動機の瞬時速度検出装置。 - 【請求項3】 電動機に取り付けられたパルス発生手段
からのパルスに基づいて電動機の位置又は回転角を検出
する位置検出手段を有する電動機の制御装置において、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差(108)を計測する時間差計測手
段(107)と、 電動機の回転速度(102)、位置又は回転角(10
3)及び負荷外乱トルク(104)の3変数を状態変数
(106)とし、システム入力を電動機トルク(10
5)、システム出力を前記位置又は回転角(103)と
した状態方程式に対して、前記サンプリングタイミング
毎に、その直前の前記パルス発生手段からのパルスの発
生時点における前記状態変数(106)を推定する状態
観測手段(101)と、 前記サンプリングタイミング毎に、前記状態観測手段
(101)により推定された状態変数(106)及び前
記時間差計測手段(107)によって計測された時間差
(108)から前記状態方程式に基づいて、該サンプリ
ングタイミングにおける電動機の加速度の瞬時値(11
2)を演算する瞬時加速度演算手段(111)と、 を有することを特徴とする電動機の瞬時加速度検出装
置。 - 【請求項4】 電動機に取り付けられたパルス発生手段
からのパルスに基づいて電動機の位置又は回転角を検出
する位置検出手段を有する電動機の制御装置において、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角、電動機トルク及び
負荷外乱トルクの4変数を状態変数とし、システム入力
を電動機トルクの指令値、システム出力を前記位置又は
回転角とした状態方程式に対して、前記サンプリングタ
イミング毎に、その直前の前記パルス発生手段からのパ
ルスの発生時点における前記状態変数を推定する状態観
測手段と、 前記サンプリングタイミング毎に、前記状態観測手段に
より推定された状態変数及び前記時間差計測手段によっ
て計測された時間差から前記状態方程式に基づいて、該
サンプリングタイミングにおける電動機の位置又は回転
角の瞬時値を演算する瞬時位置演算手段と、 を有することを特徴とする電動機の瞬時位置検出装置。 - 【請求項5】 電動機に取り付けられたパルス発生手段
からのパルスに基づいて電動機の位置又は回転角を検出
する位置検出手段を有する電動機の制御装置において、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角、電動機トルク及び
負荷外乱トルクの4変数を状態変数とし、システム入力
を電動機トルクの指令値、システム出力を前記位置又は
回転角とした状態方程式に対して、前記サンプリングタ
イミング毎に、その直前の前記パルス発生手段からのパ
ルスの発生時点における前記状態変数を推定する状態観
測手段と、 前記サンプリングタイミング毎に、前記状態観測手段に
より推定された状態変数及び前記時間差計測手段によっ
て計測された時間差から前記状態方程式に基づいて、該
サンプリングタイミングにおける電動機の速度の瞬時値
を演算する瞬時速度演算手段と、 を有することを特徴とする電動機の瞬時速度検出装置。 - 【請求項6】 電動機に取り付けられたパルス発生手段
からのパルスに基づいて電動機の位置又は回転角を検出
する位置検出手段を有する電動機の制御装置において、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角、電動機トルク及び
負荷外乱トルクの4変数を状態変数とし、システム入力
を電動機トルクの指令値、システム出力を前記位置又は
回転角とした状態方程式に対して、前記サンプリングタ
イミング毎に、その直前の前記パルス発生手段からのパ
ルスの発生時点における前記状態変数を推定する状態観
測手段と、 前記サンプリングタイミング毎に、前記状態観測手段に
より推定された状態変数及び前記時間差計測手段によっ
て計測された時間差から前記状態方程式に基づいて、該
サンプリングタイミングにおける電動機の加速度の瞬時
値を演算する瞬時加速度演算手段と、 を有することを特徴とする電動機の瞬時加速度検出装
置。 - 【請求項7】 電動機に取り付けられたパルス発生手段
からのパルスに基づいて電動機の位置又は回転角を検出
する位置検出手段を有する電動機の制御装置において、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角及び負荷外乱トルク
の3変数を状態変数とし、システム入力を電動機トル
ク、システム出力を前記位置又は回転角とした状態方程
式に対して、前記サンプリングタイミング毎に、その直
前の前記パルス発生手段からのパルスの発生時点におけ
る前記状態変数を推定する状態観測手段と、 前記サンプリングタイミング毎に、前記状態観測手段に
より推定された状態変数及び前記時間差計測手段によっ
て計測された時間差から前記状態方程式に基づいて、該
サンプリングタイミングより更に所定時間だけ遅れた時
点における電動機の位置又は回転角の瞬時値を演算する
瞬時位置演算手段と、 を有し、 該瞬時位置演算手段によって演算された瞬時位置値又は
回転角値を電動機の制御演算に用いる、 ことを特徴とする瞬時位置値を用いた電動機の制御方
法。 - 【請求項8】 電動機に取り付けられたパルス発生手段
からのパルスに基づいて電動機の位置又は回転角を検出
する位置検出手段を有する電動機の制御装置において、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角及び負荷外乱トルク
の3変数を状態変数とし、システム入力を電動機トル
ク、システム出力を前記位置又は回転角とした状態方程
式に対して、前記サンプリングタイミング毎に、その直
前の前記パルス発生手段からのパルスの発生時点におけ
る前記状態変数を推定する状態観測手段と、 前記サンプリングタイミング毎に、前記状態観測手段に
より推定された状態変数及び前記時間差計測手段によっ
て計測された時間差から前記状態方程式に基づいて、該
サンプリングタイミングより更に所定時間だけ遅れた時
点における電動機の速度の瞬時値を演算する瞬時速度演
算手段と、 を有し、 該瞬時速度演算手段によって演算された瞬時速度値を電
動機の制御演算に用いる、 ことを特徴とする瞬時速度値を用いた電動機の制御方
法。 - 【請求項9】 電動機に取り付けられたパルス発生手段
からのパルスに基づいて電動機の位置又は回転角を検出
する位置検出手段を有する電動機の制御装置において、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角及び負荷外乱トルク
の3変数を状態変数とし、システム入力を電動機トル
ク、システム出力を前記位置又は回転角とした状態方程
式に対して、前記サンプリングタイミング毎に、その直
前の前記パルス発生手段からのパルスの発生時点におけ
る前記状態変数を推定する状態観測手段と、 前記サンプリングタイミング毎に、前記状態観測手段に
より推定された状態変数及び前記時間差計測手段によっ
て計測された時間差から前記状態方程式に基づいて、該
サンプリングタイミングより更に所定時間だけ遅れた時
点における電動機の加速度の瞬時値を演算する瞬時加速
度演算手段と、 を有し、 該瞬時加速度演算手段によって演算された瞬時加速度値
を電動機の制御演算に用いる、 ことを特徴とする瞬時加速度値を用いた電動機の制御方
法。 - 【請求項10】 電動機に取り付けられたパルス発生手
段からのパルスに基づいて電動機の位置又は回転角を検
出する位置検出手段を有する電動機の制御装置におい
て、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角及び負荷外乱トルク
の3変数を状態変数とし、システム入力を電動機トル
ク、システム出力を前記位置又は回転角とした状態方程
式に対して、前記サンプリングタイミング毎に、その直
前の前記パルス発生手段からのパルスの発生時点におけ
る前記状態変数を推定する状態観測手段と、 請求項7に記載の瞬時位置演算手段、請求項8に記載の
瞬時速度演算手段又は請求項9に記載の瞬時加速度演算
手段のうち少なくとも1つと、 を有し、 前記瞬時位置演算手段によって演算された瞬時位置値若
しくは回転角値、前記瞬時速度演算手段によって演算さ
れた瞬時速度値又は前記瞬時加速度演算手段によって演
算された瞬時加速度値のうち少なくとも1つを電動機の
制御演算に用いる、 ことを特徴とする瞬時位置値、瞬時速度値又は瞬時加速
度値の少なくとも1つを用いた電動機の制御方法。 - 【請求項11】 電動機に取り付けられたパルス発生手
段からのパルスに基づいて電動機の位置又は回転角を検
出する位置検出手段を有する電動機の制御装置におい
て、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角、電動機トルク及び
負荷外乱トルクの4変数を状態変数とし、システム入力
を電動機トルクの指令値、システム出力を前記位置又は
回転角とした状態方程式に対して、前記サンプリングタ
イミング毎に、その直前の前記パルス発生手段からのパ
ルスの発生時点における前記状態変数を推定する状態観
測手段と、 前記サンプリングタイミング毎に、前記状態観測手段に
より推定された状態変数及び前記時間差計測手段によっ
て計測された時間差から前記状態方程式に基づいて、該
サンプリングタイミングより更に所定時間だけ遅れた時
点における電動機の位置又は回転角の瞬時値を演算する
瞬時位置演算手段と、 を有し、 該瞬時位置演算手段によって演算された瞬時位置値又は
回転角値を電動機の制御演算に用いる、 ことを特徴とする瞬時位置値を用いた電動機の制御方
法。 - 【請求項12】 電動機に取り付けられたパルス発生手
段からのパルスに基づいて電動機の位置又は回転角を検
出する位置検出手段を有する電動機の制御装置におい
て、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角、電動機トルク及び
負荷外乱トルクの4変数を状態変数とし、システム入力
を電動機トルクの指令値、システム出力を前記位置又は
回転角とした状態方程式に対して、前記サンプリングタ
イミング毎に、その直前の前記パルス発生手段からのパ
ルスの発生時点における前記状態変数を推定する状態観
測手段と、 前記サンプリングタイミング毎に、前記状態観測手段に
より推定された状態変数及び前記時間差計測手段によっ
て計測された時間差から前記状態方程式に基づいて、該
サンプリングタイミングより更に所定時間だけ遅れた時
点における電動機の速度の瞬時値を演算する瞬時速度演
算手段と、 を有し、 該瞬時速度演算手段によって演算された瞬時速度値を電
動機の制御演算に用いる、 ことを特徴とする瞬時速度値を用いた電動機の制御方
法。 - 【請求項13】 電動機に取り付けられたパルス発生手
段からのパルスに基づいて電動機の位置又は回転角を検
出する位置検出手段を有する電動機の制御装置におい
て、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角、電動機トルク及び
負荷外乱トルクの4変数を状態変数とし、システム入力
を電動機トルクの指令値、システム出力を前記位置又は
回転角とした状態方程式に対して、前記サンプリングタ
イミング毎に、その直前の前記パルス発生手段からのパ
ルスの発生時点における前記状態変数を推定する状態観
測手段と、 前記サンプリングタイミング毎に、前記状態観測手段に
より推定された状態変数及び前記時間差計測手段によっ
て計測された時間差から前記状態方程式に基づいて、該
サンプリングタイミングより更に所定時間だけ遅れた時
点における電動機の加速度の瞬時値を演算する瞬時加速
度演算手段と、 を有し、 該瞬時加速度演算手段によって演算された瞬時加速度値
を電動機の制御演算に用いる、 ことを特徴とする瞬時加速度値を用いた電動機の制御方
法。 - 【請求項14】 電動機に取り付けられたパルス発生手
段からのパルスに基づいて電動機の位置又は回転角を検
出する位置検出手段を有する電動機の制御装置におい
て、 サンプリングタイミング毎に、その直前の前記パルス発
生手段からのパルスの発生時点から該サンプリングタイ
ミングまでの時間差を計測する時間差計測手段と、 電動機の回転速度、位置又は回転角、電動機トルク及び
負荷外乱トルクの4変数を状態変数とし、システム入力
を電動機トルクの指令値、システム出力を前記位置又は
回転角とした状態方程式に対して、前記サンプリングタ
イミング毎に、その直前の前記パルス発生手段からのパ
ルスの発生時点における前記状態変数を推定する状態観
測手段と、 請求項11に記載の瞬時位置演算手段、請求項12に記
載の瞬時速度演算手段又は請求項13に記載の瞬時加速
度演算手段のうち少なくとも1つと、 を有し、 前記瞬時位置演算手段によって演算された瞬時位置値若
しくは回転角値、前記瞬時速度演算手段によって演算さ
れた瞬時速度値又は前記瞬時加速度演算手段によって演
算された瞬時加速度値のうち少なくとも1つを電動機の
制御演算に用いる、 ことを特徴とする瞬時位置値、瞬時速度値又は瞬時加速
度値の少なくとも1つを用いた電動機の制御方法。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP347991 | 1991-01-16 | ||
JP3-3479 | 1991-01-16 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH04281381A JPH04281381A (ja) | 1992-10-06 |
JP3055186B2 true JP3055186B2 (ja) | 2000-06-26 |
Family
ID=11558478
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP03033015A Expired - Fee Related JP3055186B2 (ja) | 1991-01-16 | 1991-02-27 | 電動機の瞬時位置・瞬時速度・瞬時加速度検出装置、ならびに瞬時位置値・瞬時速度値・瞬時加速度値を用いた電動機の制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3055186B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2869281B2 (ja) * | 1993-02-12 | 1999-03-10 | 株式会社神戸製鋼所 | モータ駆動系の制御装置 |
WO2013088533A1 (ja) | 2011-12-14 | 2013-06-20 | 株式会社安川電機 | モータ制御装置及びモータシステム |
-
1991
- 1991-02-27 JP JP03033015A patent/JP3055186B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH04281381A (ja) | 1992-10-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR950014759B1 (ko) | 회전 펄스 인코더를 사용하여 극히 저속의 범위에서 전기 모터의 속도를 제어하기 위한 시스템 및 방법 | |
JPS61164481A (ja) | 速度制御方式 | |
JPH0221237B2 (ja) | ||
JP4253372B2 (ja) | エレベータにおける速度制御装置およびエレベータの速度検出プログラムを記録した記録媒体 | |
JP3296527B2 (ja) | モータ速度制御装置 | |
Tsuji et al. | A velocity measurement method for acceleration control | |
US4503374A (en) | Speed detection apparatus and method | |
JPH0471185B2 (ja) | ||
JP3173174B2 (ja) | 速度検出装置 | |
JP3055186B2 (ja) | 電動機の瞬時位置・瞬時速度・瞬時加速度検出装置、ならびに瞬時位置値・瞬時速度値・瞬時加速度値を用いた電動機の制御方法 | |
JPH027276B2 (ja) | ||
JP2728499B2 (ja) | 電動機の速度制御装置 | |
JP5167768B2 (ja) | 電動機制御装置および電動機制御方法 | |
KR101426485B1 (ko) | 교류 전동기의 제어장치 | |
KR970066778A (ko) | 디지탈서보제어장치 | |
JP3111798B2 (ja) | 可変速駆動装置 | |
JP4127000B2 (ja) | モータ制御装置 | |
KR100491665B1 (ko) | 전동기의 속도제어장치 | |
JP2558752B2 (ja) | モータの回転速度制御装置 | |
JP2002112580A (ja) | 回転体の位相検出装置 | |
JP2002136165A (ja) | モータ制御装置の速度検出方法 | |
JP2002531834A (ja) | 混合した速度の推定 | |
KR19980033797A (ko) | 모터에서 엔코더를 이용한 속도검출 장치 및 그 방법 | |
JP3166219B2 (ja) | 電動機の速度制御装置 | |
KR19990001541A (ko) | 속도검출방법 및 장치 |
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: 20000314 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080414 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090414 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100414 Year of fee payment: 10 |
|
LAPS | Cancellation because of no payment of annual fees |