JPH09113528A - 速度検出制御装置 - Google Patents

速度検出制御装置

Info

Publication number
JPH09113528A
JPH09113528A JP27075995A JP27075995A JPH09113528A JP H09113528 A JPH09113528 A JP H09113528A JP 27075995 A JP27075995 A JP 27075995A JP 27075995 A JP27075995 A JP 27075995A JP H09113528 A JPH09113528 A JP H09113528A
Authority
JP
Japan
Prior art keywords
speed
output
unit
model
time
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
Application number
JP27075995A
Other languages
English (en)
Other versions
JP3402017B2 (ja
Inventor
Yasuhiro Yamamoto
康弘 山本
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.)
Meidensha Corp
Meidensha Electric Manufacturing Co Ltd
Original Assignee
Meidensha Corp
Meidensha Electric Manufacturing Co Ltd
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 Meidensha Corp, Meidensha Electric Manufacturing Co Ltd filed Critical Meidensha Corp
Priority to JP27075995A priority Critical patent/JP3402017B2/ja
Publication of JPH09113528A publication Critical patent/JPH09113528A/ja
Application granted granted Critical
Publication of JP3402017B2 publication Critical patent/JP3402017B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Indicating Or Recording The Presence, Absence, Or Direction Of Movement (AREA)

Abstract

(57)【要約】 【課題】 極低速域や零速判定域においても、補正動作
開始が早くなるようにして安定に動作させるようにし
た。 【解決手段】 電動機の回転軸から回転位相を検出し、
その位相と発生時刻をラッチして、前回のラッチデータ
との位相差と時間差により速度検出部21で速度検出を
行う。一方、トルク指令とトルク推定との差からモデル
速度演算部22でモデル速度を演算し、このモデル速度
演算出力の平均値を前記速度検出部21でラッチした時
間差の期間だけ第1の平均化処理部23aで演算する。
この第1の平均化処理部23aと第2の平均化処理部2
6からのモデル速度の平均値をモデル速度に応じてコン
パレータ回路CP1で切り替えて前記速度検出部21か
らのリミッタ回路C5を通った速度検出出力で減算し、
その差からトルク推定出力を負荷トルク推定部24で得
る。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】この発明は、誘導機のベクト
ル制御装置に係わり、特にロータリーエンコーダ等のパ
ルス発生器を利用した速度検出方式において、回転速度
が極低速域での運転が可能な速度制御装置に関する。
【0002】
【従来の技術】現在では、ディジタル演算器が高性能に
構成されるようになってきたため、モータ及び負荷の機
械系のモデルを制御演算器の内部に持って、モデルの挙
動を演算することができるようになってきている。この
ため、上記演算器の高性能化により、可変速駆動装置を
用いて電動機を速度制御する用途において、負荷急変時
の速度低下を抑制するインパクトドロップ補償が、例え
ば鉄鋼の圧延設備などで実施されるようになって来てい
る。
【0003】この制御原理として、モデルの速度と検出
速度とから負荷トルクを推定する負荷トルクオブザーバ
が提案され、現在盛んに使用されている。負荷トルクオ
ブザーバに関しても、種々な方式が提案されているが、
以下最小次元負荷トルクオブザーバを使用した例で説明
する。この負荷トルクオブザーバの原理ブロック図を図
3に示す。また、この負荷トルクオブザーバを発展さ
せ、ロータリーエンコーダのパルス間隔が速度制御周期
より長くなるような極低速域を改善する速度オブザーバ
の方式も提案されている。この速度オブザーバの制御ブ
ロック図を図4に示す。
【0004】前記負荷トルクオブザーバは速度検出デー
タとモデル速度を比較しているが、極低速域では、ロー
タリーエンコーダの発生するパルス周期が非常に長くな
り、制御周期毎にパルスが発生しない期間がでてくるた
め、速度検出データが連続して得られなくなってしま
う。このような間欠的な速度検出条件では、トルクオブ
ザーバの演算自体が停止してしまい、システム全体も正
常に動作しなくなる。このような極低速域での対策は論
文などにもいまだ発表されていない。
【0005】まず、エンコーダパルスを用いた速度検出
方式の原理について述べるに、図5に示すロータリーエ
ンコーダを使用した速度制御系について考える。図5に
おいて、11は速度指令と速度検出との偏差を採る偏差
器で、この偏差器11の偏差出力を速度制御部12を介
してモータドライバ13に供給する。14はモータドラ
イバ13により駆動されるモータである。15はモータ
14の速度を検出するロータリーエンコーダで、このロ
ータリーエンコーダ15が出力する2相エンコーダ信号
は速度演算部16に供給される。速度演算部16の出力
には速度検出信号が得られる。
【0006】速度演算部16は図6に示すように構成さ
れていて、そのタイミングチャートは図7のようにな
る。なお、2相エンコーダ信号は図7(a),(b)に
示すように90°位相差のある方形波である。図6にお
いて、A1はロータリエンコーダの2相パルス信号PP
A,PPBの波形整形を行い、パルス信号の立ち上が
り、立ち下がりエッジの時刻(j)にエッジトリガ信号
EDGを発生する波形整形回路である。また、この波形
整形回路A1はパルスのエッジの種類を判定し、正転、
反転に対応した位相カウンタA2のアップ、ダウン制御
信号D/Uも出力する。この波形整形回路A1から出力
されるエッジトリガ信号により位相カウンタA2はロー
タリエンコーダの回転位相に相当してアップ、ダウンす
る。A3は時間を計測するための基準クロック信号発生
部で、この発生部A3で得られた基準クロック信号は基
準時刻カウンタA4と速度制御周期タイマA5に供給さ
れる。この基準時刻カウンタA4は基準クロック信号発
生部A3の信号をカウントアップして、時刻を出力す
る。また、速度制御周期タイマA5は速度演算ルーチン
の開始信号を発生し、速度演算周期Ts毎にサンプリン
グ(以下サンプルと称す)トリガ(i)を出力するもの
である。
【0007】A6はサンプルトリガ(i)の直前のパル
スエッジ(j)での位相角を保持する第1ダブルラッ
チ、A7は前回のサンプル(i−1)の直前のパルスエ
ッジ(j−1)での位相角を保持する第2ダブルラッチ
である。A8は第1、第2ダブルラッチA6とA7のサ
ンプル値を減算して{(j−1),(j)}間の位相差
を求める第1減算器である。A9はサンプル(i)の直
前のパルスエッジ(j)の発生時刻をラッチする第3ダ
ブルラッチ、A10は前回のサンプル(i−1)の直前
のパルスエッジ発生時(j−1)の時刻をラッチする第
4ダブルラッチである。A11は第3、第4ダブルラッ
チA9とA10のサンプル値を減算し、{(j−1),
(j)}間の時間差を計算する第2減算器である。A1
3は除算器で、第1減算器A8の出力位相差を、第4減
算器A11の出力時間差で除算することにより、速度検
出値を出力するものである。なお、除算器A13の演算
は、次の(1)式により行われる。
【0008】 ωM(j-1→j)={θM(j)-θM(j-1)}/{t(j)-t(j-1)} ……(1) ωM(j-1→j):検出速度 θM(x):xのエンコーダエッジの発生時の回転位相
角 t(x):xのエンコーダエッジの発生時の時刻 本来は、(1)式の演算はパルスエッジ(j)が発生し
た直後に演算が可能であるが、実際には速度検出結果を
利用して速度制御演算を行うのは、タイマA5のTsの
時間周期(サンプル時刻をiで示す)毎に実行する図7
の符号B1で示した速度制御演算ルーチンにおいてであ
る。そのため、実際にはパルスの発生時刻ではなく、サ
ンプル時刻(i)から始まる速度制御ルーチンの先頭
(図7の符号B2で示す)で速度演算が行われている。
【0009】また、計測パルスの選択に関しては、速度
検出の精度のためにはできるだけパルス間隔を広く取る
必要があり、かつ、検出時間遅れも少なくするために
(i−1)の直前のパルスエッジ{ここでは(j−1)
と定義する}と、(i)の直前のパルスエッジ{(j)
と定義する}とを使用するとよい。このように、サンプ
リング周期の直前の(j)のデータをラッチする方式を
ブロック図で記述するため、図6に符号A6で示すよう
なダブルラッチの記号を使用した。図6において、SW
1はエッジの発生周期毎にラッチし、次のパルスエッジ
まで値を保持し、これをさらにSW2により(i)の時
刻でラッチすることにより、前述の(i)の時刻の直前
のパルスエッジのデータを選択してラッチすることが可
能となる。なお、図6ではラッチタイミングの種類を判
別しやすくするために、異なったラッチの記号で記述し
ているが、どちらもデータ保持としての機能は同じであ
る。
【0010】次に極低速域のロータリーエンコーダの出
力パルスについて述べる。ある程度の速度から速度が低
下し、零速度に到達する場合のタイミングチャートを図
8に示す。ロータリーエンコーダの出力パルスは、速度
が低下するにつれて間隔が長くなり、零速になるとパル
スが発生しなくなる。ここで、サンプル間隔とパルスの
有無により図8は3種類の領域に分類できる。
【0011】分類1(正常動作):エンコーダパルスj
がサンプル周期間TS毎に常に発生している場合、この
場合は、速度検出がサンプル毎に検出可能である。
【0012】分類2(極低速域):分類1と次の分類3
との間には、サンプル周期毎にはパルスが発生しない
が、Tmax以内には次のパルスが発生する条件が存在す
る。この場合は、極低速で回転していると判断する。
【0013】分類3(零速域)前回のエンコーダパルス
の発生時刻から、Tmaxの設定時刻より長い間次のパル
スが発生しない場合、この場合は前記(1)式の速度演
算を中止し、速度検出値を零に設定する。
【0014】前述した負荷トルクオブザーバの方式は、
上記分類の内(分類1)の期間のみしか正常に動作でき
ない。そのため、サンプル周期間にパルスが発生せず速
度検出ができなければ、負荷トルクオブザーバの値は更
新されず前回値がずっと保持されたままになる。このよ
うな従来方式の負荷トルクオブザーバの構成を図9に示
す。この図9は図3の負荷トルクオブザーバと図6の速
度検出方式とを組み合わせたものである。図9におい
て、21は速度検出部、22はモデル速度演算部、23
は平均化処理部、24は負荷トルク推定部である。速度
検出部21は図6に示す速度検出方式に次の構成要件が
追加されたものである。
【0015】零速判定部A12、切り替えスイッチA1
4及びSRラッチA15を追加する。零速判定部A12
は、第4減算器A11の出力である時間差が設定零速検
出期間Tmax以内に制限するリミッタLIMと、Tmax
オーバした場合にはZ(j−1→j)の零速検出信号
を”1”にするコンパレータCOPとで構成される。な
お、リミッタLIMは前記(1)式の分母がオーバフロ
ーしないように制限するものである。切り替えスイッチ
A14は、零速判定部A12のコンパータCOPの出力
Z(j−1→j)が”1(零速検出)”の場合、除算器
A13の速度演算結果を強制的に零に切り替える動作を
行うものである。SRラッチA15は波形整形回路A1
のエッジトリガjによりセットし、速度制御周期タイマ
A5のサンプルトリガ信号によりリセットするもので、
このSRラッチの機能は、サンプル周期(i−1→i)
の期間に1つ以上のパルスエッジが存在する場合には、
サンプルタイミング(i)の時点で”1”を出力し、サ
ンプル時の演算直後にリセットされる。これにより、後
述する負荷トルクオブザーバのデータの更新の可否を制
御することができる。
【0016】次に機械系のモデル速度演算部22につい
て述べる。この機械系のモデル速度演算部22は、トル
ク指令τ*と負荷トルク推定値∧τL(以下推定値には
∧印を付す)との差を求める第5減算器221と、サン
プル周期Tsとモータや負荷の慣性などより求められる
機械的時定数TM*との比を乗算する係数乗算器222
と、この係数乗算器222の出力をサンプル周期毎に積
算する累算器223とにより構成される。前記機械系の
モデル速度演算部22は出力にサンプル時刻iの時点で
のモデル速度ωM'(i)を送出する。
【0017】23は平均化処理部で、特にモデル速度の
平均化処理演算を行う。負荷トルクオブザーバにおいて
は、モデル速度と検出速度との差を求める後述する減算
器A22が必要である。しかし、速度検出ωM(j−1
→j)は(j−1→j)期間の平均値で出力されるのに
対し、モデル速度ωM'(i)は時刻(i)の瞬時値であ
る。このため、速度検出期間の時間的な整合が取れな
い。そこで、モデル速度についても、速度検出期間(j
−1→j)と同一期間での平均値ωM'(j−1→j)を
求めるものである。この処理部内では、次のA18から
A21により構成されており、モデル速度の平均値を演
算する。A18はモデル位相角出力部で、この出力部A
18は、モデル速度ωM'(i)にサンプル周期期間Ts
を乗算して、サンプル期間の進み角に変換する乗算器2
24と、その進み角の位相角を累算し出力にモデルの位
相角θM'(i)を送出する累算器225とで構成され
る。
【0018】A19は第5ダブルラッチで、この第5ダ
ブルラッチA19はモデル位相角出力部A18の出力位
相角を第1ダブルラッチA6と同一のタイミングでラッ
チする。A20は第6ダブルラッチで、第2ダブルラッ
チA7と同一のタイミングで第5ダブルラッチA19の
前回値を保持するものである。A21は第5、第6ダブ
ルラッチA19とA20との位相差を零速判定部A12
の時間差で除算し、出力にモデル平均速度ωM'(j−1
→j)を送出する除算器である。
【0019】最後に負荷トルク推定部24について述べ
る。A22は減算器で、この減算器A22は平均化処理
部23の出力であるモデル速度の平均値ωM'(j−1→
j)と速度検出ωM(j−1→j)との差を演算し誤差
速度を演算するものである。A23は切り替えスイッチ
で、このスイッチA23はSRラッチA15が”1(パ
ルスが発生している)”である場合には、減算器A22
の誤差速度を選択出力し、SRラッチA15の出力が”
0(パルスが欠けている)”場合は減算器A22の出力
を無視して、前回値を続けて出力するものである。A2
4は係数乗算器で、この係数乗算器A24は切り替えス
イッチA23により選択された速度誤差にオブザーバゲ
インG1を乗算して出力に負荷トルク推定値∧τLを出
力するものである。
【0020】
【発明が解決しようとする課題】上述した負荷トルクオ
ブザーバ方式では、回転速度が十分に速くてパルスがサ
ンプル周期毎に発生する場合には、図9に示す切り替え
スイッチA23は、検出誤差を毎回更新することができ
るため、常に最新の負荷トルク推定値が得られるように
なる。しかし、回転速度が極低速域や零速検出領域にな
るとサンプル周期毎にパルスが発生しなくなり、負荷ト
ルク推定値は前回値を保持してしまう。このようなとき
には、従来は負荷トルクの推定ができないという現象が
生じてしまう問題がある。
【0021】上記のように極低速域で負荷トルクオブザ
ーバの推定が停止してしまうと、インパクトドロップ補
償や、零速オブザーバの性能の低下という問題も引き起
こしてしまう恐れがある。もし、負荷トルクの推定限界
速度を引き下げることができれば、極低速域の特性が改
善可能となり、特に、ロボットや工作機械の位置決めな
どのように低速域での特性が要求される用途などの特性
向上に有効である。
【0022】次に負荷トルクオブザーバを用いた極低速
域の速度推定の場合の問題点について述べる。動摩擦ト
ルクに比べ静止摩擦トルクの値が大きい場合には、零速
域で回転していないにもかかわらず、速度推定は回転し
ていると推定する現象が発生する。この対策としては、
速度制御周期毎にエンコーダパルスが検出できたと仮定
したときの速度予測値を用いて、速度推定値にリミッタ
をかけている。
【0023】モータが逆転から正転に変化する場合の速
度変化を図10に示す。なお、図10においては、分か
りやすいように速度制御演算は無視して、一定トルク指
令状態と近似してある。ここで、図10の(a)時点で
は逆転状態であり、トルク指令が正方向に与えられてい
るため、トルク指令と動摩擦トルクとの差により、回転
速度は減速して行く。速度が低下するにつれてエンコー
ダパルスの発生間隔は長くなり、ついに図10の(b)
時点で発生しなくなる。速度検出はこの時点が最終値と
なり、このときのモデル速度との差より負荷トルクを推
定したものが保持されてしまう。ところが、図10の
(c)時点で実回転速度が零になると動摩擦トルクが静
止摩擦トルクに変化するため、負荷トルクが急に大きく
なる。そして、モータトルクと釣り合うため零速のまま
となってしまう。しかし、速度検出がないため、負荷ト
ルクオブザーバは、上記摩擦トルクの変動を推定でき
ず、図10の(b)時点の値を相変わらず保持したまま
の状態となる。
【0024】このことが要因となって、次のような速度
推定の誤差が生じてくる。モデル速度はモータトルクか
ら推定負荷トルクを減算した推定加速トルクを機械時定
数に乗じて積分して求めているが、速度検出と、推定負
荷トルクが図10の(b)時点以降保持された状態のま
まなので、いつまでたってもモデル速度は直線的に変化
し続ける。そして、図10の時点(c)を過ぎても正転
に変化してそのまま推定値は加速して行くことになる。
このように、エンコーダパルスが無くなる極低速域で負
荷トルク推定を保持し続けると、静止摩擦により実速度
は零であるにもかかわらず、速度オブザーバの推定速度
が加速してしまう異常を発生する。
【0025】この状態を最終パルスの発生時刻から現在
の制御時間までの時間差を用いて、エンコーダパルスが
発生しない場合にも、ちょうど今パルスが発生した場合
の予測速度を計算して、予測値にリミットをかけた具体
的な制御ブロックを図11に示す。図11は図9に予測
速度演算部30と推定速度リミッタ部31を設けたもの
で、予測速度演算部30は第3ダブルラッチA9間の入
出力の減算器30aと除算器30bからなり、推定速度
リミッタ部31はωM'(i)とΔωとの減算器31a
と、この減算器31aの出力を前記予測速度演算部30
から出力される予測速度でリミットをかけるリミッタ3
1bとから構成される。ここで、ΔθPPはエンコーダの
パルス間隔の角度である。
【0026】この図11のように構成すると、速度推定
値は予測速度により制限されるが、このリミッタのかか
っている期間でもモデル速度は前述のように加速したま
まとなっている(トルク制御モードなどのように、トル
ク指令が一定の場合)。そこで、リミッタ条件下では、
次に速度検出が可能になったときに異常にならないよう
に、モデル速度の値も零速付近に補正しておかねばなら
ない問題がある。このように、従来は負荷トルクの推定
ができない現象と、零速時の速度推定の異常現象が生じ
る問題があった。
【0027】この発明は上記の事情に鑑みてなされたも
ので、エンコーダパルスが速度制御周期毎に発生しない
ような極低速域や零速判定域においても、補正動作開始
が早くなるようにして安定に動作させるようにした速度
検出制御装置を提供することを目的とする。
【0028】
【課題を解決するための手段】この発明は、上記の目的
を達成するために、第1発明に使用する可変速駆動装置
は、次のように構成されている。電動機の回転軸に取り
付けられたエンコーダからの出力パルスをカウントして
回転位相を検出し、エンコーダの出力パルスから位相と
発生時刻をラッチして、前回のラッチデータとの位相差
と時間差により速度検出部で速度検出を行う。一方、ト
ルク指令とトルク推定との差である加速トルクと負荷の
慣性による機械時定数によりモデル速度演算部でモデル
速度を演算し、このモデル速度演算出力の平均値を前記
速度検出部でラッチした時間差の期間だけ第1の平均化
処理部で演算する。この第1の平均化処理部からのモデ
ル速度の平均値と前記速度検出部からの速度検出出力と
を減算し、その差をゲイン部を介して出力にトルク推定
出力を送出する負荷トルク推定部とを備えたものであっ
て、このように構成された可変速駆動装置には以下のよ
うな構成が設けられている。
【0029】前記エンコーダからの出力パルスが発生し
ないとき、最終発生パルスの時刻と現在時刻との期間に
おけるモデル速度出力の平均値を演算する第2の平均化
処理部を設け、前記エンコーダからの出力パルスが発生
しないとき、エンコーダの1パルス相当の位相差を最終
発生パルスの時刻と現在時刻の差の時間で除算器で除算
して、予測速度を得る予測速度演算部を設け、前記速度
検出部からの速度検出出力が供給され、前記予測速度演
算部からの予測速度により、前記速度検出出力を一定の
範囲内に保持するリミッタ回路を設け、このリミッタ回
路のリミット範囲と同じ範囲に設定され、前記モデル速
度演算部からのモデル速度出力が設定値より大きいこと
を検出するコンパレータ回路と、このコンパレータ回路
の出力が生じたときに、前記第1の平均化処理部の平均
値出力を第2の平均化処理部の平均値出力に切り替える
第1の切り替えスイッチと、この第1の切り替えスイッ
チにより切り替えられる平均値出力と前記モデル速度演
算部出力および前記リミッタ回路からの出力と零速度を
前記予測速度演算部に設けられた零速判定部からの零速
判定出力により切り替えて前記負荷トルク推定部に入力
する第2および第3の切り替えスイッチと、前記モデル
速度演算部からのモデル速度と前記負荷トルク推定部に
入力された差出力との減算から推定速度を得る減算部と
を備えてなることを特徴とするものである。
【0030】第2発明は、前記コンパレータ回路は前記
減算部から得られた推定速度出力に応じて切り替えられ
ることを特徴とするものである。
【0031】
【発明の実施の形態】以下発明の実施の形態を図面に基
づいて説明するに、図9と同一部分は同一符号を付して
示す。図1は発明の実施の第1形態を示すブロック構成
図で、この図1はパルスが間欠的に発生する極低速域で
エンコーダパルスの発生しない期間と、完全に停止した
期間とにおいて有効な対策をおこなった形態である。こ
の第1形態の場合を述べる前にまず、モータは極低速域
において回転しており、エンコーダパルスが時たま発生
する条件について考える。パルスが発生しないサンプル
周期間では速度検出はできないが、次の条件を仮定し
て、従来と同様な速度演算を行ってみる。
【0032】仮定1:サンプル時刻(i)の直後にエン
コーダパルスが発生するものと仮定し、t(j+1)=
t(i)と近似する。
【0033】仮定2:位相差としてロータリーエンコー
ダの1パルス相当の角度ΔθPPが仮定1での(j→j+
1)期間に発生する。ここで、ΔθPPは前回の速度検出
ωMと同一の符号を持つものとする。
【0034】上記のように仮定すると、(i)の時刻に
パルスが発生したと仮定した場合の(j→i)区間の速
度は次の(2)式で計算できる。
【0035】 ωM(j→i)=ΔθPP/(t(i)−t(j)) … (2) ΔθPP=2π/(1回転の相パルス数) … (3) パルスが発生しなくなった当初のサンプル時点では{t
(i)−t(j)}の時間間隔が短いため、前回の速度
検出のホールド値ωM(j−1→j)に比較して(2)
式の値はかなり大きな値となる。しかし、実際のモータ
の回転速度がωM(j−1→j)の値より小さい場合に
は、しばらくすると(2)式の値がωM(j−1→j)
より小さくなってくる。もし、実際のモータが前回の速
度検出のホールド値ωM(j−1→j)の速度で回り続
けているならば、丁度(i)の時刻で1個以上のパルス
が発生する筈である。また、これより速度が速くなって
いる場合には(i)の時刻より前に1個以上のパルスが
発生しなければならない。このように(2)式の値が前
回値より小さくなっても、まだエンコーダのパルスが発
生しないということから、現在の回転速度はωM(j−
1→j)以下と判断できる。
【0036】ここで、速度検出は正負の場合があるの
で、常に正の値である(2)式の計算結果と、その負の
値との間に前回の速度検出のホールド値ωM(j−1→
j)が存在するようにリミットして速度検出を補正した
ものを有効な速度検出情報として使用する。
【0037】以上述べた速度情報を用いて、負荷トルク
オブザーバを更新することができるとともに速度推定が
できる構成のブロック図が図1である。この図1におい
て、まず、前述した仮定1の条件を設定し、(2)式の
分母である時間t(j→i)を求めるため、(i)のサ
ンプル時の基準時刻カウンタA4の基準時刻と、前回の
発生エッジの時刻t(j)(第3ダブルラッチA9の出
力)との差を、減算器C1で減算する。この時間差を用
いて零速判定部C2により零速判定する。また、前記時
間差は除算器C3に供給され、ここで、(2)式の分子
に相当するΔθPP(1パルス位相)をΔt(j→i)で
除算し、上限速度をリミッタ回路C5に設定する。リミ
ッタ回路C5の下限速度は定数回路30を介して設定す
る。前記零速判定部C2の零速判定結果Z0(j→i)
が“1”の場合は(零速の場合)、強制的に(2)式の
結果を零とし、零速判定部C2の判定結果が“0”の場
合はモータが回転中と判断する。なお、減算器C1、零
速判定部C2および除算器C3とで予測速度演算部25
が構成される。
【0038】モデル速度側も(2)式と同じ期間の平均
値を求める必要があるため、減算器C9により位相差Δ
θM’(j→i)を求め、この位相差を除算器C10に
より除算器C3と同じ時間で除算し、第2の平均化処理
部26を構成する。この第2の平均化処理部26の出力
と第1の平均化処理部23aの出力は切り替えスイッチ
TSW1の「1」側と「0」側に供給される。この切り
替えスイッチTSW1の出力はコンパレータ回路CP1
の出力により選択される。コンパレータ回路CP1には
モデル速度ωM’が供給され、このモデル速度ωM’がコ
ンパレータ回路CP1に設定された予測速度以上になる
と(すなわちモデル速度が異常加速した判定したと
き)、「1」出力が生じて切り替えスイッチTSW1の
出力として「1」側を選択する。これにより、平均モデ
ル速度が切り替えられるため、負荷トルク推定部24へ
の入力が変化し、トルク推定を再開する。
【0039】TSW2,TSW3は零速判定部C2が零
速であると検出したとき(「1」のとき)に「1」側に
切換える切り替えスイッチである。
【0040】上記のように構成することにより、パルス
が間欠的に発生する場合には、リミッタ回路C5、コン
パレータ回路CP1、切り替えスイッチTSW1が動作
し、パルスが零速判定期間Tmax以上休止した場合に
は、切り替えスイッチTSW2,TSW3が動作するよ
うになり、さらに、回転が低下し、停止した場合にはパ
ルスが発生しない時間より零速判定部C2で零速を検出
できるが、エンコーダパルスが発生しない期間でも、最
終検出パルスによる検出速度より正確な速度情報を利用
してトルク推定を更新するようになる。これにより、ト
ルク推定の極低速域での動作停止期間が従来より短くな
り、低速域での特性が改善される。
【0041】図1の回路による補償動作をパルスが間欠
的に発生する極低速域で実際には極低速であるのに対し
てモデル速度が異常に加速する場合について述べる。モ
デル速度はパルスが無い場合でも継続して演算してお
り、モデル速度の第1の平均化処理部23aの積分出力
部A18ではモデル速度を積分し続けている。そこでま
ず、エンコーダパルスが発生しない状態のまま、最後の
パルス(j)の発生時刻のモデル位相と現在のモデル位
相との差を減算器C9により求める。次に、この位相差
がエンコーダの1パルス間隔相当の位相差より大きくな
った場合を考えてみる。もし、前回の検出速度が今も継
続して維持されているならば、このとき、エンコーダも
同時に次のパルスを出力する筈である。しかし、モデル
速度が1パルス分進んだのにエンコーダパルスが発生し
ない場合はモデル速度の方が実速度より高い速度である
と判断できる。つまり、モデル速度と実速度の大小関係
という情報が得られるようになる。そこで、このような
情報があるのなら、これを用いてトルク推定を更新する
こともでき、より正確な方向にトルク推定が補正可能と
なる。トルク推定を行うためには、速度検出側も何らか
の値が必要であるが、今回のようにパルスが無い場合
は、予測速度以下に実速度は存在するので、最終パルス
による速度検出値を予測速度以下に制限して使用する。
このように予測値で、前回検出値の保持速度を制限すれ
ばより正確な速度検出情報となるこのように予測速度を
用いて速度の検出側、モデル側とも補正をすることが特
徴である。
【0042】次に、上記第1形態において、速度推定が
できることについて述べる。通常のパルスが発生してお
り、正常に速度が検出されている場合は、モデル速度か
ら、速度検出Δωと第1の平均化処理部23aによるモ
デル速度ωM’の推定値との差を減算器E1で減算し
て、その出力に推定速度∧ωMを得る。また、エンコー
ダから出力パルスが発生していないが、最終パルスから
のモデルの位相差がエンコーダの1パルス相当の位相差
より大きい場合には、モデル速度から予測速度に制限さ
れた速度検出値と第2の平均化処理部26の出力値との
差を減算することにより速度推定を行う。これにより、
エンコーダからの出力パルスが発生せず、かつ零速判定
もされていない極低速域において、実速度より明らかに
モデル速度の方が高速である条件下で、速度推定がより
正確な方向に修正が可能となる。
【0043】図2はこの発明の実施の第2形態を示すブ
ロック構成図で、この第2形態はコンパレータ回路CP
1への入力に推定速度を供給したもので、この推定速度
の場合においても、第1形態とほぼ同様な作用効果が得
られる。
【0044】
【発明の効果】以上述べたように、この発明によれば、
エンコーダパルスが速度制御周期毎に発生しないような
極低速域や零速判定域においても、負荷トルク推定が可
能となり、負荷トルク推定の誤差が少なくなる効果が得
られるとともに、速度推定を行う用途に関しては、動摩
擦と静摩擦トルクが、大きく異なる場合に発生する零速
時の速度推定の異常現象が抑制され、速度推定が零速に
収束される効果が得られる。また、この発明によれば、
モデル速度や速度推定をコンパレータ回路の比較設定値
としたので、切り替えスイッチ動作出力を得るのが早く
することができ、極低速域での補正動作開始を早くでき
るようになり、安定に動作する利点がある。
【図面の簡単な説明】
【図1】この発明の実施の第1形態を示すブロック構成
図。
【図2】この発明の実施の第2形態を示すブロック構成
図。
【図3】負荷トルクオブザーバの原理ブロック図。
【図4】速度オブザーバの制御ブロック図。
【図5】ロータリエンコーダを用いた速度制御系のブロ
ック図。
【図6】モータ回転速度検出部のブロック構成図。
【図7】図6のタイミングチャート。
【図8】零速度に到達する場合のタイミングチャート。
【図9】従来例の負荷トルクオブザーバのブロック構成
図。
【図10】逆転から正転に変化する場合の速度変化を示
す特性図。
【図11】予測値にリミットをかけた具体的な制御ブロ
ック構成図。
【符号の説明】
21…速度検出部 22…モデル速度演算部 23…平均化処理部 23a…第1の平均化処理部 24…負荷トルク推定部 25…予測速度演算部 26…第2の平均化処理部 TSW1〜TSW3…切り替えスイッチ C2…零速判定部 C5…リミッタ回路 CP1…コンパレータ回路

Claims (2)

    【特許請求の範囲】
  1. 【請求項1】 電動機と、この電動機の回転軸に取り付
    けられたエンコーダと、このエンコーダからの出力パル
    スをカウントして回転位相を検出し、エンコーダの出力
    パルスから位相と発生時刻をラッチして前回のラッチデ
    ータとの位相差と時間差により速度検出を行う速度検出
    部と、トルク指令とトルク推定との差である加速トルク
    と負荷の慣性による機械時定数によりモデル速度を演算
    するモデル速度演算部と、このモデル速度演算部からの
    モデル速度出力が供給され、このモデル速度出力の平均
    値を前記速度検出部でラッチした時間差の期間だけ演算
    する第1の平均化処理部と、この第1の平均化処理部か
    らのモデル速度の平均値と前記速度検出部からの速度検
    出出力との差を入力し、その要素の出力にトルク推定出
    力を送出する負荷トルク推定部とを備えた可変速駆動装
    置において、 前記エンコーダからの出力パルスが発生しないとき、最
    終発生パルスの時刻と現在時刻との期間におけるモデル
    速度出力の平均値を演算する第2の平均化処理部と、前
    記エンコーダからの出力パルスが発生しないとき、エン
    コーダの1パルス相当の位相差を最終発生パルスの時刻
    と現在時刻の差の時間で除算して予測速度を演算する予
    測速度演算部と、前記速度検出部からの速度検出出力が
    供給され、前記予測速度演算部からの予測速度により、
    前記速度検出出力を一定の範囲内に保持するリミッタ回
    路と、このリミッタ回路のリミット範囲と同じ範囲に設
    定され、前記モデル速度演算部からのモデル速度出力が
    設定値より大きいことを検出するコンパレータ回路と、
    このコンパレータ回路の出力が生じたときに、前記第1
    の平均化処理部の平均値出力を第2の平均化処理部の平
    均値出力に切り替える第1の切り替えスイッチと、この
    第1の切り替えスイッチにより切り替えられる平均値出
    力と前記モデル速度演算部出力および前記リミッタ回路
    からの出力と零速度を前記予測速度演算部に設けられた
    零速判定部からの零速判定出力により切り替えて前記負
    荷トルク推定部に入力する第2および第3の切り替えス
    イッチと、前記モデル速度演算部からのモデル速度と前
    記負荷トルク推定部に入力された差出力との減算から推
    定速度を得る減算部とを備えてなることを特徴とする速
    度検出制御装置。
  2. 【請求項2】 前記コンパレータ回路は前記減算部から
    得られた推定速度出力に応じて切り替えられることを特
    徴とする請求項1記載の速度検出制御装置。
JP27075995A 1995-10-19 1995-10-19 速度検出制御装置 Expired - Fee Related JP3402017B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP27075995A JP3402017B2 (ja) 1995-10-19 1995-10-19 速度検出制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP27075995A JP3402017B2 (ja) 1995-10-19 1995-10-19 速度検出制御装置

Publications (2)

Publication Number Publication Date
JPH09113528A true JPH09113528A (ja) 1997-05-02
JP3402017B2 JP3402017B2 (ja) 2003-04-28

Family

ID=17490599

Family Applications (1)

Application Number Title Priority Date Filing Date
JP27075995A Expired - Fee Related JP3402017B2 (ja) 1995-10-19 1995-10-19 速度検出制御装置

Country Status (1)

Country Link
JP (1) JP3402017B2 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2005071423A1 (ja) * 2004-01-23 2005-08-04 Toshiba Elevator Kabushiki Kaisha 回転検出装置
CN100447695C (zh) * 2005-12-26 2008-12-31 北京航空航天大学 动态速度信号测试板
JP2021143925A (ja) * 2020-03-12 2021-09-24 株式会社明電舎 速度検出装置および速度検出方法

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2005071423A1 (ja) * 2004-01-23 2005-08-04 Toshiba Elevator Kabushiki Kaisha 回転検出装置
US7357041B2 (en) 2004-01-23 2008-04-15 Toshiba Elevator Kabushiki Kaisha Rotation detection device
KR100823770B1 (ko) * 2004-01-23 2008-04-21 도시바 엘리베이터 가부시키가이샤 회전 검출 장치
CN100447695C (zh) * 2005-12-26 2008-12-31 北京航空航天大学 动态速度信号测试板
JP2021143925A (ja) * 2020-03-12 2021-09-24 株式会社明電舎 速度検出装置および速度検出方法

Also Published As

Publication number Publication date
JP3402017B2 (ja) 2003-04-28

Similar Documents

Publication Publication Date Title
US8198844B2 (en) Motor speed controller
US20100188103A1 (en) Pulse period measurement method
JPS61164481A (ja) 速度制御方式
EP0514847A2 (en) System and method for controlling speed of electric motor in extremely low speed range using rotary pulse encoder
JP3203989B2 (ja) モータの速度制御装置
US8174215B2 (en) Motor speed controller
JP3402017B2 (ja) 速度検出制御装置
JP3228168B2 (ja) 回転速度検出装置及びタイヤ発生力検出装置
JP3277454B2 (ja) 検出位置補正装置及び回転速度検出装置
JP2009095154A (ja) モータ制御装置とその速度検出方法
US11970896B2 (en) Opening/closing control device and opening/closing control method
JP3230397B2 (ja) 可変速駆動装置およびその装置を用いた速度推定装置
JPH027276B2 (ja)
JP3111798B2 (ja) 可変速駆動装置
JP2820757B2 (ja) モータ制御装置
JPH1084687A (ja) 回転モータの絶対角位置算出装置及びこれを適用した速度制御装置
JP2781232B2 (ja) モータ制御装置における定常域到達検出装置
KR100244245B1 (ko) 전동기의 속도검출방법
JP3259352B2 (ja) 電動機の速度補正演算方法
JPH06162614A (ja) 周波数電圧変換器及び速度検出装置
JP2820755B2 (ja) モータ制御装置
JP2735324B2 (ja) モータの回転速度制御装置
JP2820747B2 (ja) モータ制御装置における定常域到達検出装置
JP3230352B2 (ja) 電動機の速度制御装置
JPH10260197A (ja) 速度パルスの検出回路

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees