JPH05111295A - ステツプモータを用いた閉ループ制御装置 - Google Patents
ステツプモータを用いた閉ループ制御装置Info
- Publication number
- JPH05111295A JPH05111295A JP28726391A JP28726391A JPH05111295A JP H05111295 A JPH05111295 A JP H05111295A JP 28726391 A JP28726391 A JP 28726391A JP 28726391 A JP28726391 A JP 28726391A JP H05111295 A JPH05111295 A JP H05111295A
- Authority
- JP
- Japan
- Prior art keywords
- step motor
- drive pulse
- control signal
- control
- closed loop
- 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
- Control Of Stepping Motors (AREA)
Abstract
きるステップモータを用いた閉ループ制御装置を得る。 【構成】 ステップモータ2の駆動パルスを発生するの
に、ステップモータ2に対する速度指令を駆動パルスの
周波数に変換するモジュレータ4を用いる。このモジュ
レータ4の働きでステップモータ2は速度指令を実現す
る操作機器とみなすことができ、制御ロジック5はこの
ステップモータ2の特性と制御対象3の動特性とを考慮
して、制御偏差からステップモータ2に対する速度指令
を与えるように設計する。 【効果】 制御対象の動特性が問題になるような場合に
も、閉ループ制御の望ましい制御特性が得られる。
Description
節やアンテナなどステップモータで駆動される制御対象
を、制御偏差を用いて閉ループで制御するためのステッ
プモータを用いた閉ループ制御装置に関するものであ
る。
の理論と応用」(実教出版)p.158(1979年5月
1日発行)に基づく、従来のステップモータを用いた閉
ループ制御装置のブロック図である。図において、1は
ステップモータ駆動装置、2はステップモータ駆動装置
1で駆動されるステップモータ、3はステップモータ2
で制御される機器等の制御対象、10は駆動パルスを発
生してステップモータ駆動装置1に供給する制御装置、
11は制御偏差から補正パルスを発生してステップモー
タ駆動装置1に供給するパルス発生器、12は駆動パル
スによる制御対象3の動きを模擬するシミュレータ、1
3は制御対象3からのフィードバック量とシミュレータ
12の出力とから制御偏差を求め、パルス発生器11に
送る減算器である。
では制御対象3を駆動するのに必要な駆動パルスを生成
する。このパルスはステップモータ駆動装置1に入力さ
れ、ステップモータ2を駆動し制御対象3を動かす。一
方、制御装置10の発生する駆動パルスは同時にシミュ
レータ12にも入力され、シミュレータ12ではこの駆
動パルスによるステップモータ駆動装置1,ステップモ
ータ2,制御対象3の動きを模擬して最終的に制御対象
3の動きを予測する。減算器13ではシミュレータ12
で予測された制御対象3の動きと実際の制御対象3の動
きとの制御偏差が求められ、この制御偏差はパルス発生
器11に入力される。パルス発生器11ではこの制御偏
差が0になるように制御偏差の大きさに応じて補正パル
スを発生する。この補正パルスは駆動パルスと並行にス
テップモータ駆動装置1に入力され、両方のパルスの和
に応じたパルス数でステップモータ2が駆動される。
を用いた閉ループ制御装置は以上のように構成されてい
るので、基本的には開ループ制御であり、制御偏差に応
じて補正パルスを発生するにすぎない。そのためステッ
プモータ2を含む系の動特性を考慮した制御は困難で、
制御偏差に対して位相補償を必要とするような動的制御
ループは構成できず、制御対象3の動特性がほとんど問
題にならないような場合にしか適用できないという問題
点があった。
ためになされたもので、ステップモータを含む制御対象
の動特性を推定することを可能にし、制御対象の動特性
が問題になるような場合にまで適用できるステップモー
タを用いた閉ループ制御装置を提供することを目的とし
ている。
テップモータを用いた閉ループ制御装置は、制御偏差に
応じてゲイン制御や位相補償等を行う制御部を設けるこ
とにより、この制御部より速度制御信号を得るように成
し、この速度制御信号で駆動パルスの周波数を制御する
ようにしたものである。
いた閉ループ制御装置は、速度制御信号を駆動パルスの
周波数に変換する変換手段を、速度制御信号を積分する
積分器と、その積分出力が所定レベルを越えたとき駆動
パルスを発生するしきい値回路とで構成し、その駆動パ
ルスで積分器をリセットするようにしたものである。
いた閉ループ制御装置は、速度制御信号を駆動パルスの
周波数に変換する変換手段を、速度制御信号と駆動パル
スのフィードバック信号とを減算する演算器と、その演
算出力が所定レベルを越えたとき駆動パルスを発生する
しきい値回路とで構成したものである。
た閉ループ制御装置は、制御部において制御偏差からそ
れを効果的に減少させるような速度制御信号を発生す
る。この速度制御信号に応じて変換手段により駆動パル
スの周波数が制御される。これにより、変換手段とステ
ップモータ駆動装置とを含むステップモータの動特性が
ほぼ速度を位置に変換するものとみなせるようになる。
従って、この動特性と制御対象の動特性をともに考慮す
ることにより、動的制御による閉ループ制御が可能にな
り、ステップモータを用いた閉ループ制御系の性能が格
段に向上する。
制御信号を積分し、積分値が所定値を越えたとき駆動パ
ルスを発生するので、発生された駆動パルスの周波数は
速度制御信号に応じた値となる。
制御信号を演算器によって加え合わせ、その加算値が所
定値を越えたとき、駆動パルスを発生し、また駆動パル
スの発生と同時に演算器からはある一定の値を差し引く
ので、発生された駆動パルスの周波数は速度制御信号に
応じた値となる。
を図について説明する。図1においては図5と対応する
部分には同一符号を付して説明を省略する。図1におい
て、5は減算器13からの制御偏差に応じて閉ループ制
御におけるゲイン補償や位相補償を行い、速度制御信号
を出力する制御部としての制御ロジック、6は速度制御
信号が上限をこえないようにする速度リミッタ、4は速
度リミッタ6で制限された速度制御信号を駆動パルスの
周波数に変換する変換手段としてのモジュレータで、そ
の駆動パルスはステップモータ駆動装置1に供給され
る。
らフィードバックされるこの制御対象3の位置,移動量
等を示すフィードバック量と目標値とにより減算器13
より制御偏差が得られる。制御ロジック5はこの制御偏
差に応じてステップモータ2を速度制御するような速度
制御信号を出力する。この速度制御信号は速度リミッタ
6を通じてモジュレータ4に加えられる。
する速度制御信号をステップモータ2の駆動パルスに変
換してステップモータ駆動装置1に入力する。ステップ
モータ駆動装置1はステップモータ2の電気的な駆動回
路であり、駆動パルス通りにステップモータ2を動かす
働きをする。そしてステップモータ2は制御対象3を動
かすが、このとき制御対象3のもつ構造振動特性などが
問題になり、最悪の場合には駆動パルスの周期と構造振
動の周期とが一致して共振をひきおこす。このような状
態を避けて制御対象3の構造振動に適度な減衰を与える
ためには、駆動パルスの周波数特性をうまく設定する必
要があるが、ステップモータ2はパルスを入力とするの
で、その設定は容易ではない。
きであり、モジュレータ4を付加することでステップモ
ータ2は速度制御信号を入力とするモータとみなすこと
ができ、ステップモータ2と制御対象3を含めた系の動
特性の推定が容易になる。そして動特性の推定が行える
と、制御ロジック5を通常の速度制御を行う場合のPI
D制御等の手法で設計することにより、制御対象3のも
つ構造振動に適度な減衰を与えながら、制御偏差を減少
させることが可能となる。すなわち制御ロジック5の働
きは、目標値と制御対象3の動きとの制御偏差から、こ
の制御偏差を減少させて構造振動を励起しない、望まし
い周波数特性をもった速度制御信号を生成することであ
る。
され、速度制御信号がある一定値をこえるような場合に
は、それをある値で抑えてステップモータ2が追随でき
ないような速い速度制御信号がモジュレータ4に入力さ
れるのを防ぐようにしている。
ので、変換手段としてのモジュレータ4の実施例であ
る。図2において、7は速度制御信号を時間積分する積
分器、8は積分器7の積分出力が所定レベル±δを越え
たときに駆動パルスを発生するしきい値回路である。ま
た、積分器7は駆動パルスによりリセットされるように
成されている。
ッタ6を通った速度制御信号はモジュレータ4内部の積
分器7に入力される。そして積分器7において速度制御
信号は時間積分され、その出力はしきい値回路8に入力
される。しきい値回路8ではその入力値が+δ(δはス
テップモータの1ステップに相当する一定値)以上であ
れば正方向の駆動パルスを、また−δ以下であれば負方
向の駆動パルスを発生する。入力値が−δと+δの間に
ある場合には駆動パルスの発生は行わない。
た場合には、同時に積分器7をリセットしてその出力値
を0にする。以上の働きによってモジュレータ4は速度
制御信号の大きさに応じて駆動パルスの周波数を変換す
る変換器とみなすことができる。
ので、モジュレータ4の他の実施例である。図3におい
て、9は速度制御信号と駆動パルスをフィードバックし
た信号とが加えられる演算器としての加算器で、その加
算出力はしきい値回路8に加えられる。
6を通った速度制御信号はモジュレータ4内部の加算器
9に入力される。そして加算器9において速度制御信号
は加え合わされ、その加算出力はしきい値回路8に入力
される。しきい値回路8ではその入力値が+δ(δはあ
る一定値)以上であれば正方向の駆動パルスを、また−
δ以下であれば負方向の駆動パルスを発生する。入力値
が−δと+δの間にある場合には駆動パルスの発生は行
わない。
た場合には、同時に加算器9の入力に対して駆動パルス
と逆符号の一定の大きさの信号(この大きさはステップ
モータの1ステップに相当する)をフィードバックし、
加算器9の出力が再び−δと+δの間になるようにす
る。このときは図2の積分器7を用いる場合と異なり、
加算器9の出力は必ずしも0である必要はなく、δの大
きさを適当に設定することで、モジュレータ4の等価ゲ
インや耐雑音性能などを変化させることができる。
は加算器9の出力は0であるものとする。この働きによ
って前述と同様にモジュレータ4は速度制御信号の大き
さに応じて駆動パルスの周波数を変換する変換器とみな
すことができる。
ータ駆動装置1およびステップモータ2は、入力された
速度制御信号で指令される速度を実現するようなモータ
となり、ステップモータ2を用いた閉ループ制御系の構
成がきわめて容易になる。
でソフトウェアによって実現するときのフローチャート
を示している。計算機内部で実現するときは、まずステ
ップST1で速度制御信号υを一定のサンプリング間隔
で入力し、ステップST2で適当な定数をかけて値Σ
(これは加算器9の出力に対応する)に加え合わせる。
次にステップST3でこのΣが+δ以上と判定されたと
きは、モジュレータ4はステップST4で正方向に駆動
パルスを発生し、同時にステップST5で値Σをεだけ
減少させた後、ステップST1に戻る。
されたときは、モジュレータ4はステップST7で負方
向に駆動パルスを発生し、同時にステップST8で値Σ
をεだけ増加させた後、ステップST1に戻る。なお、
このεの大きさはステップモータの1ステップに対応す
る。また値Σが+δと−δの間にあるときには、ステッ
プST9によりモジュレータ4は駆動パルスを発生せ
ず、ステップST1に戻る。このようにモジュレータ4
は計算機内部においても容易に実現することができる。
ループ制御装置において、モジュレータ4を用いること
で、制御ロジック5の設計により系の動特性を適当に設
定することが可能となる。
差により閉ループ制御系を構成する場合を示したが、目
標値によりステップモータ2を開ループ的に駆動するよ
うな場合にもモジュレータ4は有効であり、この開ルー
プ駆動と制御偏差を用いた閉ループ駆動を併用してステ
ップモータを用いた閉ループ制御装置を構成することも
できる。
実現することもできる。ただし積分器7を計算機内部で
実現する場合は数値誤差が蓄積しやすいので、図3のモ
ジュレータ4の方が計算機内部で実現するのには適して
いる。逆に図2のモジュレータ4は電気回路で実現する
のに適したものである。モジュレータ4はこの他に速度
制御信号の電圧で制御される電圧制御発振器等で構成し
てもよい。
ば、制御偏差に応じて制御部により速度制御信号を作る
ように成し、この速度制御信号をステップモータの駆動
パルスの周波数に変換し、その特性と制御対象の動特性
をともに考慮した制御部を含む形で閉ループ制御装置を
構成したので、制御対象の動特性が問題になるような場
合にも、制御系の周波数特性を適当に設定して、精度が
よくかつ信頼性の高い制御対象の制御が行えるという効
果がある。
信号を駆動パルスの周波数に変換する変換手段を、積分
器としきい値回路とで構成したので、精度がよくかつ信
頼性の高い制御対象の制御が行えると共に、変換手段を
電気回路で容易に実現することができる効果がある。
を、演算器としきい値回路とにより構成したので、精度
がよくかつ信頼性の高い制御対象の制御が行えると共に
計算機による変換手段の実現も容易で、計算機を用いる
ことでさらに精度のよい制御が実現できるという効果が
ある。
タを用いた閉ループ制御装置を示すブロック図である。
を示すブロック図である。
を示すブロック図である。
を計算機で実現する場合のフローチャートである。
置を示すブロック図である。
Claims (3)
- 【請求項1】 ステップモータで駆動される制御対象か
らのフィードバック量と目標値との制御偏差に応じた速
度制御信号を出力する制御部と、上記制御部から得られ
る上記速度制御信号を上記ステップモータの駆動パルス
の周波数に変換する変換手段とを備えたステップモータ
を用いた閉ループ制御装置。 - 【請求項2】 上記変換手段は、上記速度制御信号を積
分する積分器と、この積分器の出力が所定レベルを越え
たとき上記駆動パルスを発生するしきい値回路とで構成
され、上記積分器は上記駆動パルスでリセットされるよ
うに成された請求項1記載のステップモータを用いた閉
ループ制御装置。 - 【請求項3】 上記変換手段は、上記速度制御信号と上
記駆動パルスをフィードバックした信号とを減算する演
算器と、上記演算器の出力が所定レベルを越えたとき上
記駆動パルスを発生するしきい値回路とで構成される請
求項1記載のステップモータを用いた閉ループ制御装
置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP28726391A JP2856961B2 (ja) | 1991-10-08 | 1991-10-08 | ステップモータを用いた閉ループ制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP28726391A JP2856961B2 (ja) | 1991-10-08 | 1991-10-08 | ステップモータを用いた閉ループ制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH05111295A true JPH05111295A (ja) | 1993-04-30 |
JP2856961B2 JP2856961B2 (ja) | 1999-02-10 |
Family
ID=17715139
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP28726391A Expired - Lifetime JP2856961B2 (ja) | 1991-10-08 | 1991-10-08 | ステップモータを用いた閉ループ制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2856961B2 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06343297A (ja) * | 1993-05-31 | 1994-12-13 | Nec Corp | ステッピングモータ回転制御装置 |
JP2006129597A (ja) * | 2004-10-28 | 2006-05-18 | Konica Minolta Photo Imaging Inc | 駆動方法、駆動機構及び撮像装置 |
-
1991
- 1991-10-08 JP JP28726391A patent/JP2856961B2/ja not_active Expired - Lifetime
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06343297A (ja) * | 1993-05-31 | 1994-12-13 | Nec Corp | ステッピングモータ回転制御装置 |
JP2006129597A (ja) * | 2004-10-28 | 2006-05-18 | Konica Minolta Photo Imaging Inc | 駆動方法、駆動機構及び撮像装置 |
JP4736399B2 (ja) * | 2004-10-28 | 2011-07-27 | コニカミノルタオプト株式会社 | 駆動機構及び撮像装置 |
Also Published As
Publication number | Publication date |
---|---|
JP2856961B2 (ja) | 1999-02-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Yao et al. | Adaptive robust motion control of linear motors for precision manufacturing | |
Veselic et al. | Improved discrete-time sliding-mode position control using Euler velocity estimation | |
KR100437178B1 (ko) | 위치 제어 장치 | |
Andoh | Moment of inertia identification using the time average of the product of torque reference input and motor position | |
US4814678A (en) | Speed control apparatus for motor | |
JPWO2006011519A1 (ja) | サーボ制御装置 | |
JPH0895643A (ja) | サーボモータのフィードフォワード制御方法 | |
KR100661106B1 (ko) | 모터의 제어장치 | |
Wang et al. | Iterative super-twisting sliding mode control for tray indexing system with unknown dynamics | |
CN110955192B (zh) | 伺服控制装置、机器人及伺服控制方法 | |
US6949905B2 (en) | Servo control system and method of setting | |
US20020063539A1 (en) | Adaptive ripple suppression/compensation apparatus for permanent magnet linear motors | |
JPH05111295A (ja) | ステツプモータを用いた閉ループ制御装置 | |
JP2004023910A (ja) | モータ制御装置 | |
JP4134599B2 (ja) | 同期制御装置 | |
JP5018410B2 (ja) | 電動機制御装置 | |
JP2002354857A (ja) | 電動機制御装置 | |
Ersalı et al. | Real time PID controlled speed regulation of a DC motor using LabVIEW | |
JPH08286759A (ja) | 静摩擦を補償するロボット駆動制御方法 | |
JPH10105247A (ja) | サーボモータのオーバーシュート防止方法 | |
JP2005182427A (ja) | 制御演算装置 | |
JP3214514B2 (ja) | 位置決め制御方法およびその装置 | |
CN114714364B (zh) | 机器人关节摩擦力补偿调节方法、机器人摩擦力补偿方法 | |
JPH10177407A (ja) | サーボ制御方法 | |
Zhao et al. | Intelligent compensation of friction, ripple, and hysteresis via a regulated chatter |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 9 Free format text: PAYMENT UNTIL: 20071127 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081127 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081127 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091127 Year of fee payment: 11 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091127 Year of fee payment: 11 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 12 Free format text: PAYMENT UNTIL: 20101127 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 13 Free format text: PAYMENT UNTIL: 20111127 |
|
EXPY | Cancellation because of completion of term |