JP2523983B2 - 速度制御装置 - Google Patents

速度制御装置

Info

Publication number
JP2523983B2
JP2523983B2 JP2305115A JP30511590A JP2523983B2 JP 2523983 B2 JP2523983 B2 JP 2523983B2 JP 2305115 A JP2305115 A JP 2305115A JP 30511590 A JP30511590 A JP 30511590A JP 2523983 B2 JP2523983 B2 JP 2523983B2
Authority
JP
Japan
Prior art keywords
memory
error
data
speed
value
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 - Lifetime
Application number
JP2305115A
Other languages
English (en)
Other versions
JPH04177512A (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.)
Panasonic Holdings Corp
Original Assignee
Matsushita Electric Industrial 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 Matsushita Electric Industrial Co Ltd filed Critical Matsushita Electric Industrial Co Ltd
Priority to JP2305115A priority Critical patent/JP2523983B2/ja
Priority to US08/170,653 priority patent/US5392378A/en
Priority to PCT/JP1991/001473 priority patent/WO1992009016A1/ja
Publication of JPH04177512A publication Critical patent/JPH04177512A/ja
Application granted granted Critical
Publication of JP2523983B2 publication Critical patent/JP2523983B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime 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
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0265Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0205Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
    • G05B13/026Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system using a predictor
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P7/00Arrangements for regulating or controlling the speed or torque of electric DC motors
    • H02P7/06Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current
    • H02P7/18Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current by master control with auxiliary power
    • H02P7/24Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current by master control with auxiliary power using discharge tubes or semiconductor devices
    • H02P7/28Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current by master control with auxiliary power using discharge tubes or semiconductor devices using semiconductor devices
    • H02P7/2805Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current by master control with auxiliary power using discharge tubes or semiconductor devices using semiconductor devices whereby the speed is regulated by measuring the motor speed and comparing it with a given physical value
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S388/00Electricity: motor control systems
    • Y10S388/90Specific system operational feature
    • Y10S388/902Compensation

Landscapes

  • Engineering & Computer Science (AREA)
  • Artificial Intelligence (AREA)
  • Medical Informatics (AREA)
  • Health & Medical Sciences (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Power Engineering (AREA)
  • Control Of Electric Motors In General (AREA)
  • Feedback Control In General (AREA)
  • Control Of Velocity Or Acceleration (AREA)

Description

【発明の詳細な説明】 産業上の利用分野 本発明は回転体の速度検出信号の周期計測により得ら
れる速度検出値に基づいて、回転体を駆動する速度制御
装置に関するものである。
従来の技術 従来より、回転体のディジタル式速度制御装置は磁気
記録再生装置において多用化されている。
第8図は、磁気記録再生装置におけるキャプスタンモ
ータの回転速度制御系の一般的なブロック図を示したも
のである。
第8図において、モータ1に取り付けられた周波数発
電機2から第9図aに示すような正弦波信号が出力され
る。この信号はモータ1の回転速度に依存した周期を有
しており、さらにFG信号増幅器3により増幅および波形
整形され、第9図bに示す方形波信号となる。FG信号増
幅器3の出力は速度誤差検出器17に入力され、入力信号
の周期がカウンタ4により量子化される。減算器6で
は、その量子化されたカウント値から基準値発生器5よ
り出力される基準周期データが減算され、速度誤差が出
力される。検出された速度誤差はディジタルフィルタ14
により速度制御領域でのゲイン補償が行われた後にD/A
変換器15に出力され、D/A変換器15の出力はモータ駆動
回路16に供給され、回転体(モータ1)の速度制御が行
われる。
発明が解決しようとする課題 ところで、上記の構成における各部の伝達関数を含め
たブロック図を第10図に示し、これをもとに回転体の速
度制御系における制御限界周波数について説明する。
第10図において、モータの伝達関数は、トルク定数Kt
(g−cm/A)と、慣性モーメントJ(g−cm・sec・sec
/rad)、およびプラス演算子sにより表される。モータ
1の回転速度は一回転あたりz個の歯数を有する周波数
発電機2(第8図においてはFGと略称されている。)に
より速度検出信号に変換され、入出力サンプラ,カウン
タ4および移動平均要素により入力信号の周期が計測さ
れる。
カウンタ4に供給される基準クロックの周波数をFck
(Hz)、サンプリング周期をT(sec)とすると、カウ
ンタ4の伝達関数Gcは次式で表される。
ただし、 カウンタ4により量子化された速度検出信号の周期計
測値から基準値が減算され、速度誤差が算出される。算
出された速度誤差は伝達関数Gfを有するディジタルフィ
ルタ14に入力され速度制御領域でのゲイン補償が行わ
れ、D/A変換器15の入力バッファにより構成される0次
ホルダに供給される。
0次ホルダの伝達関数Ghは次式で表される。
0次ホルダの出力は、変換ゲインKxを有するD/A変換
器15によりアナログ電圧に変換され、その出力は伝達コ
ンダクタンスgm(A/V)を有するモータ駆動回路16に供
給され、その出力電流によりモータの速度制御が行われ
る。
なお、D/A変換器15の変換ゲインKxは変換ビット数を
n、供給電圧をVccとすると、次式で表される。
上述の各部の伝達関数の中で、位相特性がサンプリン
グ周期Tに依存するのは、カウンタ部とホルダであり、
任意の周波数fでの両者の位相特性θc,θhは(1)
式,(3)式より次のように表される。
θc=−π・f・T …(5) θh=−π・f・T …(6) さて、一般的に制御系が安定に動作するためには、開
ループゲインが0dBとなる周波数において40〜60度の位
相余裕が必要であるが、その周波数において第10図に示
される慣性ブロック6内の慣性項が支配的となり、この
周波数において90度の位相遅れが生じる。したがって、
この周波数において60度の位相余裕を得るための必要条
件は次式で表される。
この条件によりモータを安定に制御可能な制御限界周
波数Flimは、FG周波数Ffgを用いて次式で表される。
上述のごとく、モータを安定に制御可能な制御限界周
波数は、FG周波数により規制されてしまう。このため、
速度誤差検出器に速度検出信号を入力する前に逓倍回路
を設け、サンプリング周期Tを2分の1にすることによ
り、制御限界周波数をFG周波数の6分の1まで広げるこ
とが可能である。
しかしながら、速度検出信号の一周期の時間が、速度
誤差検出からD/A変換器への出力までに要する時間の倍
以上でなければ逓倍法を用いることはできない。
すなわち、FG周波数が比較的高い場合には制御限界周
波数は(8)式で示されるようにFG周波数の12分の1が
理論上の限界値であった。
ところで、民生用VTR等においては、キャプスタンモ
ータの駆動方式として、ダイレクト・ドライブ方式が多
用されており、モータ特有のトルクリップルが回転ムラ
の要因となって、ワウ・フラッタを悪化させることとな
る。
このトルクリップルは、モータの1回転周期に依存し
ており、通常この回転周期の整数倍の高調波成分を有し
ている。
この特有の性質を利用して、モータの回転周期に依存
したトルクリップルを取り除く方法として、繰り返し制
御(または学習制御と呼ばれる)を適用した例が報告さ
れている(「システムと制御」,Vol.30,No.1,P34〜41,1
986)。
しかしながら、繰り返し制御を適応した制御方式にお
いては、モータの回転周期に依存したトルクリップルを
取り除く効果はあるものの、学習機構の実現には多くの
メモリまたはシフトレジスタを必要とし、さらに制御系
の安定性を得るために複雑な高次のフィルタ等により構
成された補償器を必要としていた。すなわち、従来の繰
り返し制御の実現においてコスト面におけるデメリット
も大きかった。
本発明は、上記従来の問題点を解決するもので、逓倍
法を用いることができないときにも、安定に速度制御が
可能な速度制御装置を提供することを目的とする。
課題を解決するための手段 この目的を達成するために本発明の速度制御装置は、
回転体の速度に応じた速度検出信号の周期を計測する計
測手段と、前記計測手段の出力データと基準周期データ
とから平均速度誤差を算出する速度誤差算出手段と、特
定の計測区間に対する平均速度誤差と、それ以前の平均
速度誤差とから瞬時速度誤差を予測する予測手段と、前
記予測手段の出力を累積加算し、平均値データを出力す
る誤差平均化手段と、特定のメモリを選択するメモリ選
択手段と、前記誤差平均化手段の出力データと、前記メ
モリ選択手段により選択された特定のメモリのデータと
を加算し、その結果を前記メモリに格納する誤差格納手
段と、前記メモリより以前に選択された特定のメモリの
データに1より小さい定数を乗じた後、前記瞬時誤差予
測手段の出力データを加算する補償誤差算出手段と、前
記補償誤差算出手段の出力データに基づいて前記回転体
を駆動する駆動手段とを備えている。
作用 本発明は上記した構成により、従来に比べて位相余裕
を大きくとることができるとともに周期的な外乱を効率
よく抑圧することができる速度制御装置を提供できる。
実施例 以下、本発明の実施例について、図面を参照しながら
説明する。
第1図は本発明の一実施例における速度制御装置の基
本ブロック図、第2図は第1図の速度誤差予測ブロック
20の詳細図、第3図は第1図の学習機構ブロック30の詳
細図を示したものであり、第8図と同一機能の部位には
同じ符号を用いている。
第1図において、FG信号増幅器3の出力信号はカウン
タ4に入力され、基準クロックにより量子化される。カ
ウンタ4のカウントデータおよび基準値発生器5の基準
値データは減算器6に供給され、カウンタ4のカウント
データから基準値データが減算されて、その演算結果デ
ータが第1のメモリ7に供給される。第1のメモリ7の
出力データは、速度誤差予測ブロック20に入力され、そ
の出力データは学習機能ブロック30に供給される。
第2図において、第1の予測器22には、第1のメモリ
7および第2のメモリ21のデータが供給され、予測演算
が行われた後に、第1のメモリ7のデータが第2のメモ
リ21に供給される。第2の予測器25には、第4のメモリ
24および第1のメモリ7のデータが供給され、予測演算
が行われた後に、第3のメモリ23のデータが第4のメモ
リ24に供給される。第3の予測器26には、第2の予測器
25および第1の予測器22の出力データが供給され、予測
演算が行われる。予測演算結果は学習機構ブロック30に
供給される。
第3図において、前述の予測演算結果は第2加算器37
および誤差平均化手段32に供給されている。誤差平均化
手段32により平均化された出力データは、第1加算器33
に入力される。第1加算器33ではメモリ選択手段34によ
りメモリ群から選択された特定のメモリのデータと誤差
平均化手段32の出力データを加算し、加算結果を同メモ
リに格納する。補償器35ではメモリ選択手段34により選
択された特定のメモリに乗数kを乗じた後、第5のメモ
リ36に演算結果を出力する。第2加算器37では、前述の
予測演算結果、すなわち第3の予測器26の出力データと
第5のメモリ36の出力とを加算し、ディジタルフィルタ
14に出力する。
なお、速度誤差予測ブロック20は、第2のメモリ21〜
第3の予測器26により、学習機構ブロック30は誤差平均
化手段32〜第2加算器37により構成されており、FG信号
増幅器3からの出力信号が制御信号として入力されてい
る。
また、ディジタルフィルタ14にもサンプリング信号と
してFG信号増幅器3の出力信号が入力されている。
以上のように構成された速度制御装置について、第1
図〜第4図をもとに動作説明を行う。
第4図はFG信号bとモータ1の速度誤差との関係を表
したものであり、モータ1の回転速度が遅くなってきて
いる状態を表している。
まず、第4図bのリーディングエッジが到来すると、
第1のメモリ7のデータは第2のメモリ21に転送され、
第3のメモリ23のデータは第4のメモリ24に転送され
る。すなわち、第2のメモリ21,第4のメモリ24には常
に第1のメモリ7,第3のメモリ23に入力された一回前の
データが格納される。これは第1の予測器22および第2
の予測器25の予測動作に備えたものである。
つぎに、第1の予測器22において、第1のメモリ7の
データの3倍のデータから第2のメモリ21のデータが減
算された後、2で除算される。この演算結果は第3のメ
モリ23に格納される。第2の予測器25では、第1のメモ
リ7の2倍のデータから第4のメモリ24のデータが減算
される。最後に、第3の予測器26において、第2の予測
器25の出力データおよび第1の予測器22の出力データと
の加重平均値が算出され、出力される。
以上の一連の処理の意味を第4図をもとに説明する。
時刻t7において、第4図bのリーディングエッジが到
来し、速度検出器17での処理が終了しているものとす
る。この時点において、第1のメモリ7には時刻t6から
時刻t7までの区間におけるモータ1の平均速度に依存し
た速度誤差データが格納されている。同様に、第2のメ
モリ21には、時刻t3から時刻t5までの区間におけるモー
タ1の平均速度に依存した速度誤差データが格納されて
いる。
ここで、時刻t3〜t7までのモータ1の速度検出信号の
2サイクル間の瞬時速度が直線近似できるものとする
と、第1のメモリ7に格納されているデータは時刻t6
つまり時刻t5〜t7の中間点での瞬時速度誤差e2を表し、
第2のメモリ21のデータは時刻t4、つまり時刻t3〜t5
中間点での瞬時速度誤差e1を表すことになる。
従って、時刻t7での瞬時速度誤差予測値R0は以下の式
で示される。
すなわち、第1の予測器22からは(9)式で表される
瞬時速度誤差予測値R0が出力される。
ところで、第4のメモリ24には時刻t5における瞬時速
度誤差予測値R1が格納されている。第2の予測器25では
時刻t5における瞬時速度誤差予測値R1、時刻t6での瞬時
速度誤差e2より以下の式で表される瞬時速度誤差予測値
R2を出力する。
R2=e2+(e2−R1) …(10) すなわち、(9)式により、前回(時刻t5)算出した
瞬時速度誤差予測値R1が今回の計算に反映されることに
なる。
第3の予測器26では上述の如く算出された瞬時速度誤
差予測値R0およびR2を加重平均し、最終的な瞬時速度誤
差予測値Rを出力する。
以上より、第1の予測器22の伝達関数Pr1をZ演算子
を用いて表すと、 同様に第2の予測器25の伝達関数Pr2は、 よって、第3の予測器26の伝達関数Pr3は、 となる。
つまり、(13)式で示される処理を行うことにより、
第1図の速度誤差予測ブロック20の処理を行うことがで
きる。
つぎに、学習機構ブロック30の動作説明を行う。回転
体の歯数をNとすると、1回転周期の間に速度検出信号
がN回検出される。さらに、平均化回数をNavgとする
と、学習RAM群で必要なRAMの数はNr(=N/Navg)とな
り、従来必要であったRAM数NのNavg分の1に削減する
ことが可能である。
いま、第3の予測器26から出力が得られた状態である
とする。誤差平均化手段32では、誤差の累積加算を開始
する。累積加算された誤差の平均化が終了するまで、す
なわち累積加算回数nが(n<Navg)の間は学習RAM群
は選択されず、第5のメモリ36のデータと第3の予測器
26の出力が加算され、ディジタルフィルタに出力され
る。誤差平均化手段32により誤差の累積加算が終了、す
なわち累積加算回数nが(n=Navg)となると、誤差平
均化手段32では累積加算された誤差を平均化する。つま
り、第3の予測器26の出力をEiとすると、誤差平均化手
段32の出力Eavgは次式で表される。
誤差の平均化が終了すると誤差平均化手段32は、平均
化された誤差Eavgを出力する。一方、メモリ選択手段34
により、学習RAM群から特定のRAMが選択される。
以下に、RAMの選択方法の説明を行う。ここで、前回
選択されたRAMがRAMk-1であるとする。このときポイン
タは前回インクリメントされているのでポインタ値np
(np=k)を示している。したがって、今回はポインタ
値(np=k)で示されるRAMkが選択され、ポインタは再
びインクリメントされる。このとき、もしインクリメン
トされたポインタ値npが学習RAMの数Nrより大きけれ
ば、すなわち、(k+1>Nr)であれば、ポインタはリ
セットされる。
以上の処理によりモータ1の1回転周期をモードとし
てRAM1〜RAMNrをサイクリックに選択することが可能で
ある。
RAMkが選択されると、前述の誤差平均化手段32の出力
と選択されたRAMkのデータとが加算され、その演算結果
が再びRAMkに格納される。以上で学習機能の学習動作は
終了する。
つぎに、ディジタルフィルタ14に実際に出力する誤差
データの算出方法の説明を行う。
まず、メモリ選択器34により今回学習したRAMkより1
回前に学習した、RAMk-1が選択される。ここで、モータ
1による位相遅れを補償するために今回学習したRAMk
選択せず、1回前に学習したRAMk-1を選択する。
以下に、位相進めのための位相量の算出方法を説明す
る。
RAM1つ分の位相進めを行った場合、進めた位相量に対
応した進みのむだ時間Tincは、次式で表される。
補償器35では、メモリ選択手段34により選択されたRA
Mk-1のデータにあらかじめ決められた定数kを乗じ、第
5のメモリ36に格納する。ここで、定数kの値は1より
小さい任意の値を選択することができ、1に近づくほど
学習効果は大きくなるが、制御系の安定性の確保が困難
となる。
第5図は第1図の学習機構ブロック30をZ演算子を用
いて表したブロック図であり、学習機構部の伝達関数GL
をZ演算子Zおよびプラス演算子sを用いて表すと次式
で示される。
(16)式よりサーボ系の制御帯域内において、kが1
に近づくにつれて分母の第2項はゼロに近づくが、1よ
り小さくなるにつれてゲインGLは1に近づき学習効果が
なくなることが容易にわかる。
つまり、学習効果とサーボ系の安定性は互いにトレー
ドオフの関係にあるため、一般的にはkを0.9以上の値
とする。
つぎに、第5のメモリ36のデータと第3の予測器26の
出力とを加算し、ディジタルフィルタ14に出力する。
このように学習機構ブロック30の各部の処理により速
度誤差予測ブロック20の出力から補償誤差が算出され
る。
つぎに、上述の速度誤差予測ブロック20および学習機
構ブロック30の処理をソフトウェアにより実現すること
を想定し、各ブロック図での処理を実現するフローチャ
ートを第6図に、このフローチャートに対応したブロッ
ク図を第7図に示し、処理の説明を行う。
ここで、用いられているカウント値は第1図のカウン
タ4の出力、基準値は第1図の基準値発生器5の出力で
あり、メモリ1〜メモリNrは第7図のメモリ1〜メモリ
Nrに対応している。ただし、メモリ4はテンポラリーの
メモリとする。第1図の減算器6,速度誤差予測ブロック
20,学習機構ブロック30での演算およびディジタルフィ
ルタ14は、マイクロプロセッサの有する算術論理演算ユ
ニット(ALU)により容易に実行可能である。
なお、演算の簡素化を図って、(13)式を変形して
(17)式の形で実現するものとする。
まず、処理ブランチ600において、第1図のFG信号増
幅器3の出力信号のリーディングエッジが到来している
かどうかを判断する。このとき到来していれば、処理ブ
ロック601においてカウント値から基準値が減算され、
その減算結果はメモリ1に転送される。到来していなけ
れば処理を終了する。処理ブロック602ではメモリ1か
らメモリ2のデータが減算され、その減算結果はメモリ
4に転送される。さらに、処理ブロック603ではメモリ
1のデータの3倍のデータがレジスタに転送される。こ
の処理では、一度メモリ1のデータをレジスタに転送
し、レジスタにメモリ1のデータを2回加算することに
より、乗算命令を用いずにメモリ1のデータの3倍のデ
ータをレジスタに転送することができる。処理ブロック
604では、レジスタの値にメモリ3のデータが加算され
再びレジスタに転送される。処理ブロック605ではレジ
スタの値が2回右にシフトされ、再びレジスタに転送さ
れる。処理ブロック606ではレジスタの値にメモリ4の
データが加算され、その結果はメモリ4に格納される。
処理ブロック607ではメモリ4のデータがレジスタに
転送される。この処理は、次の学習機構ブロック30での
演算に備えたものである。
処理ブロック608では速度誤差予測ブロック20での次
回の計算に備えてメモリ2のデータをメモリ3へメモリ
1のデータをメモリ2へ転送する。
以上の処理ブランチ600〜処理ブロック608の簡単な算
術演算により第1図の速度誤差予測ブロック20の処理を
実現可能である。
つぎに、学習機構ブロック30での処理の説明を行う。
誤差平均化手段32は、処理ブランチ609〜処理ブロッ
ク612により構成されている。処理ブランチ609では、累
積加算された誤差を平均化するタイミングであるかどう
かを判断する。平均化のタイミングでなければ、処理ブ
ロック610によりメモリ5のデータにメモリ4のデータ
を加算し、結果をメモリ5に格納する。そして、処理ブ
ロック620にジャンプする。
平均化のタイミングであれば、処理ブロック611によ
り累積加算されたメモリ5のデータを平均化回数Navg
除算する。その除算結果はレジスタに格納される。な
お、この平均化回数も、2のn乗にとることによりシフ
ト演算により実行可能である。処理ブロック612では、
累積加算用のメモリ5をクリアして、つぎの累積加算に
備えている。
メモリ選択手段34は処理ブロック613〜処理ブロック6
18により構成されている。
処理ブロック613ではポインタ1をインクリメントす
る。つぎに、処理ブランチ614においてポインタ1の値
が学習ramの数Nrより大きいかどうかを判断する。この
とき大きければ、処理ブロック615によりポインタ1を
リセットする。そして、処理ブロック616にジャンプす
る。小さいときには、処理ブロック616により、そのポ
インタ値に対応したメモリNpを選択する。処理ブロック
617では、選択されたメモリNpにレジスタ値を加算し、
再びメモリNpに格納する。処理ブロック618ではポイン
タ1より1小さい値を有するポインタ2によりメモリN
p-1を選択する。
補償器35は、処理ブロック619により構成されてい
る。処理ブロック619では、選択されたメモリNp-1に定
数kを乗算し、その結果をメモリ6に格納する。ここ
で、定数kは、シフト演算が可能な値を選択する。処理
ブロック620では、メモリ4のデータとメモリ6のデー
タを加算し、その結果をメモリ4に格納する。以上の演
算により学習機構ブロック30の処理が終了する。
最後に、処理ブロック621により、メモリ4のデータ
がディジタルフィルタ14に出力される。
なお、一連の演算処理において、乗算命令を用いずに
加減算およびシフト演算により処理を行っているため、
処理時間は非常に短く、むだ時間要素はほとんど生じな
い。
第11図は、従来例のカウンタ4+ホルダ、本実施例の
速度誤差予測ブロック20+ホルダの位相特性をシミュレ
ーションした結果であり、サンプリング周期Tを1msと
している。ここで、本実施例での位相遅れ量は、従来例
の2分の1となっている。
したがって、本発明によれば(14)式で示される予測
演算をソフトウェア演算により実行することにより、
(5)式で示されるカウンタ部の位相遅れ量を理論上ゼ
ロにすることができる。
本発明での位相特性は次式で表される。
θc=0 …(5)′ よって、(5)′,(6),(7)式よりモータを安
定に制御可能な制御限界周波数FlimはFG周波数Ffgを用
いて次式で表される。
上述のごとく、本発明によれば、(14)式で示される
予測演算をソフトウェア演算により実行することによ
り、(5)式で示されるカウンタ部の位相遅れを取り除
くことができる。
したがって、理論上、モータを安定に制御可能な制御
限界周波数を逓倍法を用いずに、FGの周波数の6分の1
まで延ばすことが可能である。
さらに、学習機構ブロック30により回転体の回転周期
に同期した外乱を抑圧することができるため、従来より
安定に回転体の速度制御を行うことが可能である。
発明の効果 以上のように本発明は、回転体の速度に応じた速度検
出信号の周期を計測する計測手段と、前記計測手段の出
力データと基準周期データとから平均速度誤差を算出す
る速度誤差演算手段と、特定の計測区間に対する平均速
度誤差と、それ以前の平均速度誤差とから瞬時速度誤差
を予測する予測手段と、前記予測手段の出力を累積加算
し、平均値データを出力する誤差平均化手段と、特定の
メモリを選択するメモリ選択手段と、前記誤差平均化手
段の出力データと、前記メモリ選択手段により選択され
た特定のメモリのデータとを加算し、その結果を前記メ
モリに格納する誤差格納手段と、前記メモリにより以前
に選択された特定のメモリのデータに1より小さい定数
を乗じた後、前記瞬時誤差予測手段の出力データを加算
する補償誤差算出手段と、前記補償誤差算出手段の出力
データに基づいて前記回転体を駆動する駆動手段とを備
えおり、カウンタ部による位相遅れを取り除くことがで
きるとともに回転体の回転周期に同期した外乱を抑圧す
ることができる。
したがって、従来の2倍の周波数まで安定性を維持し
つつ制御帯域を広げることが可能である。
さらに、瞬時速度誤差予測ブロック20および学習機能
ブロック30での処理をソフトウェア演算により行ってい
るため、ハードウェアの追加が必要なく、その実用効果
は極めて大きい。
【図面の簡単な説明】
第1図は本発明の実施例における速度制御装置の構成を
示すブロック図、第2図は同実施例の速度誤差予測ブロ
ック20の内部構成を示すブロック図、第3図は同実施例
の学習機構ブロック30の内部構成を示すブロック図、第
4図は同実施例の動作説明のためのタイムチャート、第
5図は同実施例における学習機構ブロック30のブロック
線図、第6図は速度誤差予測ブロック20および学習機構
ブロック30の処理を実行するためのフローチャート、第
7図は第6図のフローチャートに対応したブロック図、
第8図は従来例における速度制御装置の構成を示すブロ
ック図、第9図は同従来例のタイムチャート、第10図は
同従来例の速度制御系の各部の伝達関数を表すブロック
線図、第11図は従来例と本発明の実施例における位相特
性の比較図である。 1……モータ、2……周波数発電機、14……ディジタル
フィルタ、15……D/A変換器、16……モータ駆動回路、1
7……速度誤差検出器、20……速度誤差予測ブロック、3
0……学習機構ブロック。

Claims (3)

    (57)【特許請求の範囲】
  1. 【請求項1】回転体の速度に応じた速度検出信号の周期
    を計測する計測手段と、 前記計測手段の出力データと基準周期データとから平均
    速度誤差を算出する速度誤差算出手段と、 特定の計測区間に対する平均速度誤差と、それ以前の平
    均速度誤差とから瞬時速度誤差を予測する予測手段と、 前記予測手段の出力を累積加算し、平均値データを出力
    する誤差平均化手段と、 特定のメモリを選択するメモリ選択手段と、 前記誤差平均化手段の出力データと、前記メモリ選択手
    段により選択された特定のメモリのデータとを加算し、
    その結果を前記メモリに格納する誤差格納手段と、 前記メモリより以前に選択された特定のメモリのデータ
    に1より小さい定数を乗じた後、前記瞬時誤差予測手段
    の出力データを加算する補償誤差算出手段と、 前記補償誤差算出手段の出力データに基づいて前記回転
    体を駆動する駆動手段とを備えた速度制御装置。
  2. 【請求項2】予測手段は、連続した2つの各計測区間の
    平均速度誤差から瞬時速度誤差を予測する請求項1記載
    の速度制御装置。
  3. 【請求項3】メモリ選択手段は、速度検出信号を分周し
    た周期ごとにポインタで示される特定のメモリの選択お
    よび前記ポインタのインクリメントを行い、前記ポイン
    タの値が回転体の1回転に対応した最大値を越えたとき
    には、前記ポインタの値をリセットする請求項1記載の
    速度制御装置。
JP2305115A 1990-11-09 1990-11-09 速度制御装置 Expired - Lifetime JP2523983B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2305115A JP2523983B2 (ja) 1990-11-09 1990-11-09 速度制御装置
US08/170,653 US5392378A (en) 1990-11-09 1991-10-29 Speed controlling system and a predictor
PCT/JP1991/001473 WO1992009016A1 (en) 1990-11-09 1991-10-29 Speed control device and predicting machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2305115A JP2523983B2 (ja) 1990-11-09 1990-11-09 速度制御装置

Publications (2)

Publication Number Publication Date
JPH04177512A JPH04177512A (ja) 1992-06-24
JP2523983B2 true JP2523983B2 (ja) 1996-08-14

Family

ID=17941283

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2305115A Expired - Lifetime JP2523983B2 (ja) 1990-11-09 1990-11-09 速度制御装置

Country Status (3)

Country Link
US (1) US5392378A (ja)
JP (1) JP2523983B2 (ja)
WO (1) WO1992009016A1 (ja)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3107259B2 (ja) * 1992-12-01 2000-11-06 富士ゼロックス株式会社 回転体駆動制御装置
JP3203989B2 (ja) * 1994-10-25 2001-09-04 松下電器産業株式会社 モータの速度制御装置
US6075332A (en) * 1998-05-14 2000-06-13 Mccann; Roy A. Predictive conductive angle motor control system for brake-by-wire application
CN104811106B (zh) * 2015-04-23 2018-11-09 深圳怡化电脑股份有限公司 直流电机闭环控制的方法和***
JP6846213B2 (ja) * 2017-01-20 2021-03-24 山洋電気株式会社 モータ制御装置

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2039078B (en) * 1978-12-27 1982-11-24 Ibm Sampled data servo positioning system
US4563623A (en) * 1982-08-23 1986-01-07 Hitachi, Ltd. Motor speed control apparatus
JPS62114488A (ja) * 1985-11-13 1987-05-26 Fuji Electric Co Ltd 電動機の速度制御方式
JPS62152020A (ja) * 1985-12-26 1987-07-07 Matsushita Electric Ind Co Ltd デイジタルサ−ボ制御装置
JPS62260574A (ja) * 1986-05-06 1987-11-12 Mitsubishi Electric Corp モ−タの回転速度検出方法
US4743821A (en) * 1986-10-14 1988-05-10 International Business Machines Corporation Pulse-width-modulating feedback control of electromagnetic actuators
JPS6428701A (en) * 1987-07-24 1989-01-31 Yaskawa Denki Seisakusho Kk Learning type motor-driven actuator speed fluctuation reducing method
JPH01126185A (ja) * 1987-11-09 1989-05-18 Matsushita Electric Ind Co Ltd 速度制御装置
US4925312A (en) * 1988-03-21 1990-05-15 Staubli International Ag Robot control system having adaptive feedforward torque control for improved accuracy
US4893066A (en) * 1988-09-19 1990-01-09 Hewlett-Packard Company Hybrid sample rate servo motor controller
JPH0285902A (ja) * 1988-09-22 1990-03-27 Mitsubishi Electric Corp フィードフォワード制御装置
JPH02159990A (ja) * 1988-12-10 1990-06-20 Fanuc Ltd サーボモータの速度制御方式
US5128813A (en) * 1990-06-21 1992-07-07 Quantum Corporation Thermal compensated head positioner servo for disk drive
US5187417A (en) * 1990-08-06 1993-02-16 Cincinnati Milacron Inc. Motor control apparatus and method

Also Published As

Publication number Publication date
WO1992009016A1 (en) 1992-05-29
US5392378A (en) 1995-02-21
JPH04177512A (ja) 1992-06-24

Similar Documents

Publication Publication Date Title
US5467004A (en) Motor speed control apparatus for keeping the speed of the motor fixed in the presence of a disturbance torque
JPS61116986A (ja) 速度制御装置
JP2523983B2 (ja) 速度制御装置
US20150260551A1 (en) Encoder and drive device
JP3203989B2 (ja) モータの速度制御装置
JP2523973B2 (ja) 速度制御装置
US6470291B1 (en) Velocity feedback measurement method
JP2558752B2 (ja) モータの回転速度制御装置
JPH07229910A (ja) パルスカウンタ回路
JP2638854B2 (ja) 速度制御装置
JP2000078875A (ja) 位相同期ループを用いたサーボ制御装置及びサーボ制御方法、ジッターの測定方法並びに軌道指定のための制御方法
JP2574396B2 (ja) 速度誤差検出装置
JPH01126185A (ja) 速度制御装置
JPS6218988A (ja) モ−タの速度制御装置
JPS6246004B2 (ja)
JP3050876B2 (ja) モータの回転位相制御装置
JP2693335B2 (ja) モータ制御装置
JP2607974B2 (ja) 遅れ補正付きパルスコーダ
JP2563388B2 (ja) モータの回転速度制御装置
KR900005763B1 (ko) 제어장치
JPS6227036Y2 (ja)
JP2506856B2 (ja) モ―タの回転速度制御装置
JPS6289487A (ja) モ−タの速度制御装置
JP2553591B2 (ja) モータの回転速度制御装置
JPH0384463A (ja) 速度検出回路