JP2006174607A - ステッピングモータ制御装置及びそれを用いたペンレコーダ - Google Patents
ステッピングモータ制御装置及びそれを用いたペンレコーダ Download PDFInfo
- Publication number
- JP2006174607A JP2006174607A JP2004364181A JP2004364181A JP2006174607A JP 2006174607 A JP2006174607 A JP 2006174607A JP 2004364181 A JP2004364181 A JP 2004364181A JP 2004364181 A JP2004364181 A JP 2004364181A JP 2006174607 A JP2006174607 A JP 2006174607A
- Authority
- JP
- Japan
- Prior art keywords
- stepping motor
- pulse
- control device
- control unit
- pulse signal
- 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
- 230000005284 excitation Effects 0.000 claims description 22
- 238000005259 measurement Methods 0.000 claims description 14
- 238000010586 diagram Methods 0.000 description 10
- 238000001514 detection method Methods 0.000 description 4
- 238000012937 correction Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000000034 method Methods 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000001174 ascending effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P8/00—Arrangements for controlling dynamo-electric motors rotating step by step
- H02P8/34—Monitoring operation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
- G05B19/21—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device
- G05B19/23—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control
- G05B19/231—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P8/00—Arrangements for controlling dynamo-electric motors rotating step by step
- H02P8/14—Arrangements for controlling speed or speed and torque
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P8/00—Arrangements for controlling dynamo-electric motors rotating step by step
- H02P8/36—Protection against faults, e.g. against overheating or step-out; Indicating faults
- H02P8/38—Protection against faults, e.g. against overheating or step-out; Indicating faults the fault being step-out
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/34—Director, elements to supervisory
- G05B2219/34217—Microprocessor with build in pwm
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41326—Step motor
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42233—Pwm signal to low pass filter, compared to feedback position, if equal stop motor
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42237—Pwm pulse width modulation, pulse to position modulation ppm
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42238—Control motor position with direction signal and pwm signal for position
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Stepping Motors (AREA)
Abstract
【課題】 高精度の位置決め及び高速移動を低消費電力で行うステッピングモータ制御装置及びそれを用いたペンレコーダを実現する。
【解決手段】 ステッピングモータ制御装置及びそれを用いたペンレコーダに関し、特にエンコーダを用いた閉ループ制御のステッピングモータ制御装置及びそれを用いたペンレコーダに関するものである。
入力パルス信号に応じてステッピングモータの励磁コイルを駆動するドライバと、
該ドライバに与える前記パルス信号を変化させてステッピングモータの回転を制御するＰＷＭ制御部と、ステッピングモータの回転に応じて回転し、移動対象の位置に対応したパルスを出力するパルスエンコーダと、該パルスエンコーダより出力されるパルスをカウントして移動対象の現在位置を検出する位置カウンタと、前記ＰＷＭ制御部に移動対象の目標位置と現在位置との偏差に応じて前記ドライバに与える前記パルス信号の更新待ち時間を制御するレート制御信号を与えるパルスレート制御部とを設けた。
【選択図】 図１
【解決手段】 ステッピングモータ制御装置及びそれを用いたペンレコーダに関し、特にエンコーダを用いた閉ループ制御のステッピングモータ制御装置及びそれを用いたペンレコーダに関するものである。
入力パルス信号に応じてステッピングモータの励磁コイルを駆動するドライバと、
該ドライバに与える前記パルス信号を変化させてステッピングモータの回転を制御するＰＷＭ制御部と、ステッピングモータの回転に応じて回転し、移動対象の位置に対応したパルスを出力するパルスエンコーダと、該パルスエンコーダより出力されるパルスをカウントして移動対象の現在位置を検出する位置カウンタと、前記ＰＷＭ制御部に移動対象の目標位置と現在位置との偏差に応じて前記ドライバに与える前記パルス信号の更新待ち時間を制御するレート制御信号を与えるパルスレート制御部とを設けた。
【選択図】 図１
Description
本発明は、ステッピングモータ制御装置及びそれを用いたペンレコーダに関し、特にエンコーダを用いた閉ループ制御のステッピングモータ制御装置及びそれを用いたペンレコーダに関するものである。
ステッピングモータは、パルス信号で開ループ制御が行え、モータの回転角度と入力パルス数は一致する。しかし、開ループ制御による駆動では、高速回転時に脱調による位置ずれが発生する場合がある。そこで、これに対応するため、ステッピングモータにエンコーダを付加し、閉ループ制御を行う制御装置が従来より提案されている。
図８は従来のステッピングモータ制御装置の構成図である。図８において、ステッピングモータ１のモータ軸には、５枚羽根エンコーダディスク２がモータ励磁位置と一定の関係をもって圧入されて取り付けられている。このエンコーダディスク２の回転を２個のフォトセンサ３ａ，３ｂで検出する。フォトセンサ３ａ，３ｂの出力信号はエンコーダ回路４に入力され、エンコーダディスク２の回転方向及び回転数が検出される。これにより、ステッピングモータ１の回転に応じて移動する図示しない移動対象の絶対位置が検出できる。エンコーダ回路４の出力信号はＡＳＩＣ化されたデジタル回路５に入力されている。デジタル回路５は、エンコーダ回路４から入力される移動対象の絶対位置データとＣＰＵ６から入力される位置指定データとの差（偏差）が零になる所定の方向にステッピングモータ１を回転駆動させるように閉ループ制御を行う。
例えばペンレコーダでは、このようなステッピングモータにエンコーダを付加した閉ループ制御を用い、サーボ系によるペンの位置制御を行っている。すなわち、測定記録信号は、図示しないＡ／Ｄ変換器でデジタルデータに変換されてＣＰＵ６に入力される。ＣＰＵ６は、測定記録信号の値の大きさに応じた位置指定データに変換してデジタル回路５に入力する。デジタル回路５には、エンコーダ回路４を介してペンの現在位置データも入力されている。デジタル回路５は、２相励磁信号をドライバ７に入力してステッピングモータ１を２相励磁駆動し、移動対象であるペンが測定記録信号の値の大きさに応じた位置指定データに追従して移動するように位置制御を行う。これにより、記録紙には、ペンにより、測定記録信号の変化状態が連続した線分として記録されることになる。
２相励磁駆動とマイクロステップ駆動とを高速、かつ滑らかに切り換えるステッピングモータ駆動装置を示したものとして、例えば特許文献１に記載されたものがあった。
また、ステッピングモータの高精度の位置決め及び高速移送と、低い振動性とをともに実現するステッピングモータ制御装置を示したものとして、例えば特許文献２に記載されたものがあった。
特開平８−１４９８９２号公報
特開平１０−１５０７９８号公報
また、ステッピングモータの高精度の位置決め及び高速移送と、低い振動性とをともに実現するステッピングモータ制御装置を示したものとして、例えば特許文献２に記載されたものがあった。
しかし、図８の従来例では次の問題点があった。
エンコーダで位置検出して閉ループ制御によりステッピングモータを駆動する場合、閉ループ制御によるエンコーダ位置検出パルスからモータ駆動パルスを生成するため、モータ駆動回路はシンプルになるものの、速度制御ができなかった。
また、２相励磁駆動の場合、ミクロ的にはステップ状の動きになるので、モータの回転が滑らかではなく、移動対象を滑らかに動かすことができなかった。
エンコーダで位置検出して閉ループ制御によりステッピングモータを駆動する場合、閉ループ制御によるエンコーダ位置検出パルスからモータ駆動パルスを生成するため、モータ駆動回路はシンプルになるものの、速度制御ができなかった。
また、２相励磁駆動の場合、ミクロ的にはステップ状の動きになるので、モータの回転が滑らかではなく、移動対象を滑らかに動かすことができなかった。
本発明は上述した問題点を解決するためになされたものであり、高精度の位置決め及び高速移動を低消費電力で行うステッピングモータ制御装置及びそれを用いたペンレコーダを実現することを目的とする。
このような課題を達成するために、本発明は次のとおりの構成になっている。
（１）入力パルス信号に応じてステッピングモータの励磁コイルを駆動するドライバと、
該ドライバに与える前記パルス信号を変化させてステッピングモータの回転を制御するＰＷＭ制御部と、
ステッピングモータの回転に応じて回転し、移動対象の位置に対応したパルスを出力するパルスエンコーダと、
該パルスエンコーダより出力されるパルスをカウントして移動対象の現在位置を検出する位置カウンタと、
前記ＰＷＭ制御部に移動対象の目標位置と現在位置との偏差に応じて前記ドライバに与える前記パルス信号の更新待ち時間を制御するレート制御信号を与えるパルスレート制御部と、
を有することを特徴とするステッピングモータ制御装置。
（１）入力パルス信号に応じてステッピングモータの励磁コイルを駆動するドライバと、
該ドライバに与える前記パルス信号を変化させてステッピングモータの回転を制御するＰＷＭ制御部と、
ステッピングモータの回転に応じて回転し、移動対象の位置に対応したパルスを出力するパルスエンコーダと、
該パルスエンコーダより出力されるパルスをカウントして移動対象の現在位置を検出する位置カウンタと、
前記ＰＷＭ制御部に移動対象の目標位置と現在位置との偏差に応じて前記ドライバに与える前記パルス信号の更新待ち時間を制御するレート制御信号を与えるパルスレート制御部と、
を有することを特徴とするステッピングモータ制御装置。
（２）前記パルスレート制御部は、前記偏差に応じた待ち時間を経過した後に前記パルス信号を変化させることを特徴とする（１）記載のステッピングモータ制御装置。
（３）前記パルスレート制御部は、前記偏差に応じた待ち時間を規定したパルスレートテーブルを基に前記パルス信号を制御することを特徴とする（２）記載のステッピングモータ制御装置。
（４）前記ＰＷＭ制御部は、ステッピングモータの動作状態に応じた複数の動作モードを識別し、該複数の動作モード毎に前記パルス信号の最大パルス幅を制限することを特徴とする（１）乃至（３）のいずれかに記載のステッピングモータ制御装置。
（５）前記ＰＷＭ制御部は、ステッピングモータの動作状態に応じて前記複数の動作モード毎に前記パルス信号の最大パルス幅が違う相ＰＷＭテーブルを切り換えることを特徴とする（４）記載のステッピングモータ制御装置。
（６）前記複数の動作モードは、初期動作、通常動作、パワーダウン動作、静止動作であることを特徴とする（４）又は（５）記載のステッピングモータ制御装置。
（７）前記ＰＷＭ制御部は、前記偏差により前記複数の動作モードを識別することを特徴とする（４）乃至（６）のいずれかに記載のステッピングモータ制御装置。
（８）前記ＰＷＭ制御部は、ステッピングモータの回転方向による速度差を補正するため、前記複数の動作モード毎に相ＰＷＭテーブルを進角補正した進角相ＰＷＭテーブルの中から回転方向による速度差が小さくなるように最適な進角相ＰＷＭテーブルを選択することを特徴とする（４）乃至（７）のいずれかに記載のステッピングモータ制御装置。
（９）前記パルスレートテーブル及び相ＰＷＭテーブルにより、前記初期動作時、パワーダウン動作時及び静止動作時にはマイクロステップ駆動を行い、前記通常動作時には２相励磁駆動を行うことを特徴とする（６）乃至（８）記載のステッピングモータ制御装置。
（１０）
入力パルス信号に応じてステッピングモータの励磁コイルを駆動するドライバと、
該ドライバに与える前記パルス信号を変化させてペンを移動させるステッピングモータの回転を制御するＰＷＭ制御部と、
ステッピングモータの回転に応じて回転し、ペンの位置に対応したパルスを出力するパルスエンコーダと、
該パルスエンコーダより出力されるパルスをカウントしてペンの現在位置を検出する位置カウンタと、
前記ＰＷＭ制御部に測定記録信号の大きさに応じたペンの目標位置と現在位置との偏差に応じて前記ドライバに与える前記パルス信号の更新待ち時間を制御するレート制御信号を与えるパルスレート制御部と、
を有することを特徴とするペンレコーダ。
（１０）
入力パルス信号に応じてステッピングモータの励磁コイルを駆動するドライバと、
該ドライバに与える前記パルス信号を変化させてペンを移動させるステッピングモータの回転を制御するＰＷＭ制御部と、
ステッピングモータの回転に応じて回転し、ペンの位置に対応したパルスを出力するパルスエンコーダと、
該パルスエンコーダより出力されるパルスをカウントしてペンの現在位置を検出する位置カウンタと、
前記ＰＷＭ制御部に測定記録信号の大きさに応じたペンの目標位置と現在位置との偏差に応じて前記ドライバに与える前記パルス信号の更新待ち時間を制御するレート制御信号を与えるパルスレート制御部と、
を有することを特徴とするペンレコーダ。
本発明によれば次のような効果がある。
移動対象の目標位置と現在位置との偏差に応じてドライバに与えるパルス信号のレートを制御することで速度制御が可能となり、かつ２相励磁駆動とマイクロステップ駆動を切り換えることにより、ステッピングモータの高精度の位置決めと高速移動を実現することができる。
移動対象の目標位置と現在位置との偏差に応じてドライバに与えるパルス信号のレートを制御することで速度制御が可能となり、かつ２相励磁駆動とマイクロステップ駆動を切り換えることにより、ステッピングモータの高精度の位置決めと高速移動を実現することができる。
また、ステッピングモータのマイクロステップ動作、速度制御及びパワーダウン制御を実施するのにあたり、ＣＰＵ演算を行わず予め設定されているテーブルの値を切り換えて行うので、ＣＰＵの負荷を軽減することができる。
また、ステッピングモータの動作状態に応じてパルス信号の最大パルス幅を制限することにより駆動電流を押さえ、消費電力を低減することができる。
また、進角補正を用いたテーブルを使用した校正をすることで、ステッピングモータの回転方向による速度差を小さくすることができる。
さらに、このようなステッピングモータ制御装置をペンレコーダのペン位置制御に使用することにより、ペンレコーダのペンを、高速・高精度で、測定記録信号の値に応じた目的位置に移動させることができる。
以下、図面を用いて本発明を詳細に説明する。
図１は本発明の一実施例を示す構成図である。ステッピングモータ制御装置をペンレコーダのペン位置制御に使用した場合について説明する。測定記録信号は、図示しないＡ／Ｄ変換器でデジタルデータに変換されてＣＰＵ６に入力される。ＣＰＵ６は、測定記録信号の値の大きさに応じた位置指定データに変換し、メモリ１０及びＡＳＩＣ化されているデジタル回路２０に入力する。デジタル回路２０には、エンコーダディスク２の回転検出信号に基づくペンの現在位置データも入力されている。デジタル回路２０は、駆動制御信号をドライバ３０に入力してステッピングモータ１を駆動し、移動対象であるペンが測定記録信号の値の大きさに応じた位置指定データに追従して移動するように位置制御を行う。これにより、記録紙には、ペンにより、測定記録信号の変化状態が連続した線分として記録されることになる。
図１は本発明の一実施例を示す構成図である。ステッピングモータ制御装置をペンレコーダのペン位置制御に使用した場合について説明する。測定記録信号は、図示しないＡ／Ｄ変換器でデジタルデータに変換されてＣＰＵ６に入力される。ＣＰＵ６は、測定記録信号の値の大きさに応じた位置指定データに変換し、メモリ１０及びＡＳＩＣ化されているデジタル回路２０に入力する。デジタル回路２０には、エンコーダディスク２の回転検出信号に基づくペンの現在位置データも入力されている。デジタル回路２０は、駆動制御信号をドライバ３０に入力してステッピングモータ１を駆動し、移動対象であるペンが測定記録信号の値の大きさに応じた位置指定データに追従して移動するように位置制御を行う。これにより、記録紙には、ペンにより、測定記録信号の変化状態が連続した線分として記録されることになる。
ステッピングモータ１は、ドライバ３０の入力パルス信号に応じて励磁コイルが駆動されることにより回転する。
ステッピングモータ１のモータ軸には、例えば５枚羽根のエンコーダディスク２がモータ励磁位置と一定の関係をもって圧入されて取り付けられている。エンコーダディスク２の回転は、検出信号に所定の位相差を生じるように配置された２個のフォトセンサ３ａ，３ｂで検出される。２個のフォトセンサ３ａ，３ｂの検出信号はデジタル回路２０内のカウントパルス生成部２１に入力され、パルス生成される。カウントパルス生成部２１の出力パルスは位置カウンタ２２に入力され、回転方向が検出されるとともに、現在位置がカウントされる。
位置演算器２３は、ＣＰＵ６からレジスタ２４に書かれた測定記録信号の値の大きさに基づく図示しないペンの目標位置と位置カウンタ２２のカウント値に基づく現在位置との差（偏差）を演算する。
パルスレート制御部２５は、目標位置に対する現在位置の偏差が大きい場合と小さい場合に応じて、パルス信号の更新周期を異ならせるレート制限を行う。
ＰＷＭ制御部２６は、位置演算器２３出力とエンコーダ出力をもとに回転方向、ＰＷＭデータの更新を行いステッピングモータ１の回転及び停止の決定を行う。この制御にあたり、メモリ１０に展開したパルスレートテーブル４０と相ＰＷＭテーブル５０を使用する。ここで、パルスレートテーブル４０は、目標位置と現在位置との偏差及びパルス信号のレートを変化させる待ち時間を対応させたテーブルであり、相ＰＷＭテーブル５０は、相励磁のパルス信号のデューティを表したテーブルである。
ＰＷＭ制御部２６から、ステッピングモータ１の回転方向信号と、ＰＷＭデータ生成器２７で生成されたパルス信号をドライバ３０へ送る。
図２はパルスレートテーブルを説明する図である。ペンの目標位置と現在位置との偏差が小さくなるに従ってパルス信号のレートを変化させる待ち時間を大きくしている。
図２の場合、偏差が大きく６４以上であれば待ち時間なしで２相励磁駆動を行い、偏差が小さくなるとマイクロステップ駆動に切り換え、偏差に応じた更新待ち時間をテーブルから選択する。
図２の場合、偏差が大きく６４以上であれば待ち時間なしで２相励磁駆動を行い、偏差が小さくなるとマイクロステップ駆動に切り換え、偏差に応じた更新待ち時間をテーブルから選択する。
図３は相ＰＷＭテーブルによるマイクロステップ駆動を説明する図である。図３（ａ）はマイクロステップ駆動電流を示す図であり、図３（ｂ）は相ＰＷＭテーブルの考え方を示す図である。
２相励磁駆動の場合、図３（ｂ）のＮｏ．１，４，７，１０のポイントで切り換えて動作させるが、マイクロステップ駆動の場合、Ｎｏ．０〜１１のポイントを順番に１ポイントずつ切り換えて動作させる。Ｎｏ．０〜１１のポイントを昇順に切り換える場合と降順に切り換える場合とでステッピングモータの回転方向が変わる。
２相励磁駆動の場合、図３（ｂ）のＮｏ．１，４，７，１０のポイントで切り換えて動作させるが、マイクロステップ駆動の場合、Ｎｏ．０〜１１のポイントを順番に１ポイントずつ切り換えて動作させる。Ｎｏ．０〜１１のポイントを昇順に切り換える場合と降順に切り換える場合とでステッピングモータの回転方向が変わる。
図４は相ＰＷＭテーブルを説明する図である。図４（ａ）は初期動作の相ＰＷＭテーブル、図４（ｂ）は通常動作の相ＰＷＭテーブル、図４（ｃ）はパワーダウン動作の相ＰＷＭテーブル、図４（ｄ）は静止動作の相ＰＷＭテーブルの具体例を示す。
ステッピングモータの動作状態で必要な駆動電流の大きさが異なるので、駆動電流を動作状態に応じて適切に制御することにより消費電力の低減を図ることができる。
ステッピングモータの動作状態で必要な駆動電流の大きさが異なるので、駆動電流を動作状態に応じて適切に制御することにより消費電力の低減を図ることができる。
このような駆動電流の大きさの制御は、ドライバ３０に入力するパルス信号のデューティを変化させることで実現する。図４はデューティ１００％時のデータ値を“２５５“とした例であって、初期動作時はデューティ５０％、通常動作時はデューティ４７％、パワーダウン動作時はデューティ３８％、静止動作時はデューティ２５％とした場合のデータ値を示している。
初期動作時は、ペンが０％側のストッパーの位置まで低速で移動してストッパーに当たり、エンコーダディスク２の回転が停止したことを検出してゼロ位置とするので、確実にストッパーまで移動させるために駆動電流が一番大きい相ＰＷＭテーブルを使用する。
通常動作は、ペンの目標位置と現在位置との偏差が大きい場合の高速移動時の動作であり、２相励磁駆動で高速回転するのである程度大きな駆動電流が必要である。
パワーダウン動作は、ペンの目標位置と現在位置との偏差が小さい場合の減速移動時の動作であり、マイクロステップ駆動で回転させ、駆動電流は小さく押さえることができる。
静止動作は、ペンが目標位置に到達した場合であり、駆動電流が一番小さい相ＰＷＭテーブルを使用する。
図４では各相ＰＷＭテーブルはＮｏ．０〜１１までについてＡ相及びＢ相のＤａｔａをそれぞれ規定しているが、Ａ相についてＮｏ．０〜５までのＡ相のＤａｔａを規定しておき、Ｎｏ．６〜１１までについては逆極性で対応し、Ｂ相についてはＡ相から位相を−９０°ずらすことで対応することもできる。
図５は相ＰＷＭテーブルの遷移手順を示したフローチャートである。
ペンの目標位置と現在位置との偏差が規定値（例えば６４）より大きいか小さいかを判断する（Ｓ１）。
ペンの目標位置と現在位置との偏差が規定値より大きい場合は通常動作の相ＰＷＭテーブルを使用し、規定値より小さくなるまで通常動作の相ＰＷＭテーブルを使用する（Ｓ２）。
ペンの目標位置と現在位置との偏差が規定値より小さい場合はパワーダウン動作の相ＰＷＭテーブルを使用する（Ｓ３）。
ペンが目標位置に到達すると静止動作の相ＰＷＭテーブルを使用し（Ｓ４，Ｓ５）、目標位置が移動するまで静止動作の相ＰＷＭテーブルを使用する（Ｓ６）。
ペンの目標位置と現在位置との偏差が規定値（例えば６４）より大きいか小さいかを判断する（Ｓ１）。
ペンの目標位置と現在位置との偏差が規定値より大きい場合は通常動作の相ＰＷＭテーブルを使用し、規定値より小さくなるまで通常動作の相ＰＷＭテーブルを使用する（Ｓ２）。
ペンの目標位置と現在位置との偏差が規定値より小さい場合はパワーダウン動作の相ＰＷＭテーブルを使用する（Ｓ３）。
ペンが目標位置に到達すると静止動作の相ＰＷＭテーブルを使用し（Ｓ４，Ｓ５）、目標位置が移動するまで静止動作の相ＰＷＭテーブルを使用する（Ｓ６）。
図６は進み角のイメージ図である。
エンコーダディスク２がステッピングモータ１の励磁相に対して理想的に取り付けられていない場合、ステッピングモータ１の時計回り回転と反時計回り回転とで速度差が生じる。そこで、この速度差を無くすため進み角制御により補正を行う。遅い方の回転が早くなるように進角補正することにより、逆に早い方の回転は遅くなる。
エンコーダディスク２がステッピングモータ１の励磁相に対して理想的に取り付けられていない場合、ステッピングモータ１の時計回り回転と反時計回り回転とで速度差が生じる。そこで、この速度差を無くすため進み角制御により補正を行う。遅い方の回転が早くなるように進角補正することにより、逆に早い方の回転は遅くなる。
図７は進角相ＰＷＭテーブルを説明する図である。
図７は、１．５°進角補正した相ＰＷＭテーブルの例であり、この他にも進角の違う複数のテーブルを予め用意しておく。ペン位置の調整時に、これら進角の相ＰＷＭテーブルを切り換えて時計回り回転、反時計回り回転で速度差が小さくなる最適なテーブルを選択し、調整値として格納しておく。
図７は、１．５°進角補正した相ＰＷＭテーブルの例であり、この他にも進角の違う複数のテーブルを予め用意しておく。ペン位置の調整時に、これら進角の相ＰＷＭテーブルを切り換えて時計回り回転、反時計回り回転で速度差が小さくなる最適なテーブルを選択し、調整値として格納しておく。
このように構成することにより、ペンレコーダのペンを、高速・高精度で、測定記録信号の値に応じた目的位置に移動させることができる。
ペンレコーダに必要なペンサーボモータ動作を行うためのＣＰＵ６の処理は、最初にパルスレートテーブル４０及び相ＰＷＭテーブル５０をメモリ１０に展開した後は、測定記録信号をデジタル信号に変換した目標位置データのみをレジスタ２４に書き込むだけでよく、ペン位置制御のためのＣＰＵ負荷を大幅に軽減できる。
ペンレコーダに必要なペンサーボモータ動作を行うためのＣＰＵ６の処理は、最初にパルスレートテーブル４０及び相ＰＷＭテーブル５０をメモリ１０に展開した後は、測定記録信号をデジタル信号に変換した目標位置データのみをレジスタ２４に書き込むだけでよく、ペン位置制御のためのＣＰＵ負荷を大幅に軽減できる。
本発明はペン位置制御をＡＳＩＣ化されたデジタル回路２０でデジタル処理することによりＣＰＵ６の負荷を軽くすることを特徴とするものであるが、ＣＰＵ６でさらにきめ細かい処理を行うことにより、より滑らかなペンサーボモータ動作が可能になる。
ステッピングモータの駆動電流をＰＷＭ制御し、２相励磁動作からマイクロステップ動作に切り替わるのと同時にパワーダウンさせ、ペンの移動停止後はさらに電流を小さくすることにより、モータの励磁コイルの温度上昇を一定温度以下に抑えることができる。
ペンを目標位置に対して高精度で停止させることができる。本例の相ＰＷＭテーブル４０を使用して、マイクロステップ駆動させることにより、エンコーダディスク２の分解能（モータ２相励磁ポイントの分解能）を例えば0.1mmとすると、その1/3の分解能（約33μm）で停止させることができる。
組立て時の誤差などで回転方向によってペンの移動速度に違いが生じている場合、進角補正により速度差がある一定の値以下になるように調整でき、安定した記録動作が実現できる。
ペン移動時の速度制御をパルスレートテーブルを用いて行うので、目標位置が遠いときは２相励磁で駆動することにより高速移動させ、目標位置に近づくとマイクロステップ動作に切り替えて徐々に減速停止させることができ、高速移動と高精度の位置決めを合わせて実現できる。
なお、移動対象は実施例で説明した記録計のペンに限るものではなく、目標位置に対して、動き始めは高速で移動し、目標位置に近づくと減速して停止するという本発明の特徴を生かして、軽量な対象であれば動作させることができる。
例えば、部品等の組み立てラインにおいて、部品の形状検査をするためのセンサ（移動対象）を本発明のステッピングモータ制御装置により移動させ、部品に近づけて位置を検査することができる。
また、アナログのメータ指示を左右や上下に動かす機構として装置等に組み込み、使用することもできる。
１ ステッピングモータ
２２ 位置カウンタ
２５ パルスレート制御部
２６ ＰＷＭ制御部
３０ ドライバ
４０ パルスレートテーブル
５０ 相ＰＷＭテーブル
２２ 位置カウンタ
２５ パルスレート制御部
２６ ＰＷＭ制御部
３０ ドライバ
４０ パルスレートテーブル
５０ 相ＰＷＭテーブル
Claims (10)
- 入力パルス信号に応じてステッピングモータの励磁コイルを駆動するドライバと、
該ドライバに与える前記パルス信号を変化させてステッピングモータの回転を制御するＰＷＭ制御部と、
ステッピングモータの回転に応じて回転し、移動対象の位置に対応したパルスを出力するパルスエンコーダと、
該パルスエンコーダより出力されるパルスをカウントして移動対象の現在位置を検出する位置カウンタと、
前記ＰＷＭ制御部に移動対象の目標位置と現在位置との偏差に応じて前記ドライバに与える前記パルス信号の更新待ち時間を制御するレート制御信号を与えるパルスレート制御部と、
を有することを特徴とするステッピングモータ制御装置。 - 前記パルスレート制御部は、前記偏差に応じた待ち時間を経過した後に前記パルス信号を変化させることを特徴とする請求項１記載のステッピングモータ制御装置。
- 前記パルスレート制御部は、前記偏差に応じた待ち時間を規定したパルスレートテーブルを基に前記パルス信号を制御することを特徴とする請求項２記載のステッピングモータ制御装置。
- 前記ＰＷＭ制御部は、ステッピングモータの動作状態に応じた複数の動作モードを識別し、該複数の動作モード毎に前記パルス信号の最大パルス幅を制限することを特徴とする請求項１乃至３のいずれかに記載のステッピングモータ制御装置。
- 前記ＰＷＭ制御部は、ステッピングモータの動作状態に応じて前記複数の動作モード毎に前記パルス信号の最大パルス幅が違う相ＰＷＭテーブルを切り換えることを特徴とする請求項４記載のステッピングモータ制御装置。
- 前記複数の動作モードは、初期動作、通常動作、パワーダウン動作、静止動作であることを特徴とする請求項４又は５記載のステッピングモータ制御装置。
- 前記ＰＷＭ制御部は、前記偏差により前記複数の動作モードを識別することを特徴とする請求項４乃至６のいずれかに記載のステッピングモータ制御装置。
- 前記ＰＷＭ制御部は、ステッピングモータの回転方向による速度差を補正するため、前記複数の動作モード毎に相ＰＷＭテーブルを進角補正した進角相ＰＷＭテーブルの中から回転方向による速度差が小さくなるように最適な進角相ＰＷＭテーブルを選択することを特徴とする請求項４乃至７のいずれかに記載のステッピングモータ制御装置。
- 前記パルスレートテーブル及び相ＰＷＭテーブルにより、前記初期動作時、パワーダウン動作時及び静止動作時にはマイクロステップ駆動を行い、前記通常動作時には２相励磁駆動を行うことを特徴とする請求項６乃至８記載のステッピングモータ制御装置。
- 入力パルス信号に応じてステッピングモータの励磁コイルを駆動するドライバと、
該ドライバに与える前記パルス信号を変化させてペンを移動させるステッピングモータの回転を制御するＰＷＭ制御部と、
ステッピングモータの回転に応じて回転し、ペンの位置に対応したパルスを出力するパルスエンコーダと、
該パルスエンコーダより出力されるパルスをカウントしてペンの現在位置を検出する位置カウンタと、
前記ＰＷＭ制御部に測定記録信号の大きさに応じたペンの目標位置と現在位置との偏差に応じて前記ドライバに与える前記パルス信号の更新待ち時間を制御するレート制御信号を与えるパルスレート制御部と、
を有することを特徴とするペンレコーダ。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2004364181A JP4665507B2 (ja) | 2004-12-16 | 2004-12-16 | ペンレコーダ |
| US11/302,188 US7339342B2 (en) | 2004-12-16 | 2005-12-14 | Stepper motor controlling apparatus and pen recorder |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2004364181A JP4665507B2 (ja) | 2004-12-16 | 2004-12-16 | ペンレコーダ |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2006174607A true JP2006174607A (ja) | 2006-06-29 |
| JP4665507B2 JP4665507B2 (ja) | 2011-04-06 |
Family
ID=36652619
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2004364181A Active JP4665507B2 (ja) | 2004-12-16 | 2004-12-16 | ペンレコーダ |
Country Status (2)
| Country | Link |
|---|---|
| US (1) | US7339342B2 (ja) |
| JP (1) | JP4665507B2 (ja) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100850032B1 (ko) | 2008-02-28 | 2008-08-04 | 주식회사 다스텍 | 모터 충격 보호 장치 및 방법 |
| JP2009065770A (ja) * | 2007-09-06 | 2009-03-26 | Yokogawa Electric Corp | ステッピングモータ制御装置 |
| JP2012095521A (ja) * | 2010-09-30 | 2012-05-17 | Semiconductor Energy Lab Co Ltd | 電源回路 |
| CN108572610A (zh) * | 2017-03-13 | 2018-09-25 | 欧姆龙株式会社 | 评价系统、安全控制器、可读取记录媒体及评价方法 |
| CN112019104A (zh) * | 2020-08-26 | 2020-12-01 | 佛山市指擎科技有限公司 | 一种步进电机驱动方法、步进电机驱动装置及小型机械臂 |
Families Citing this family (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008092652A (ja) * | 2006-09-29 | 2008-04-17 | Fujitsu Ltd | ステッピングモータ制御装置、ステッピングモータ制御方法およびステッピングモータ制御システム |
| JP4420079B2 (ja) * | 2007-07-26 | 2010-02-24 | ソニー株式会社 | パルスモータの制御装置、制御方法、制御プログラム、撮像装置 |
| US7863851B2 (en) * | 2007-08-22 | 2011-01-04 | National Instruments Corporation | Closed loop stepper motor control |
| JP5093624B2 (ja) * | 2010-01-20 | 2012-12-12 | 株式会社デンソー | モータ制御装置 |
| CN103181072B (zh) * | 2011-03-30 | 2014-11-05 | 松下电器产业株式会社 | 超前角值设定方法、马达驱动控制电路以及无刷马达 |
| JP2013025268A (ja) * | 2011-07-26 | 2013-02-04 | Canon Inc | 光学機器 |
| KR101993656B1 (ko) * | 2012-11-16 | 2019-06-26 | 휴렛-팩커드 디벨롭먼트 컴퍼니, 엘.피. | 화상 형성 장치 및 그 제어 방법, 모터 상태 검출 장치 |
| FR3058595B1 (fr) * | 2016-11-04 | 2019-01-25 | STMicroelectronics (Grand Ouest) SAS | Procede pour piloter de facon adaptative un moteur pas a pas, et dispositif correspondant |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6335199A (ja) * | 1986-07-26 | 1988-02-15 | Canon Electronics Inc | ステツピングモ−タの駆動制御方式 |
| JPH0352599A (ja) * | 1989-07-19 | 1991-03-06 | Japan Servo Co Ltd | ２軸駆動方法 |
| JPH06189598A (ja) * | 1992-12-16 | 1994-07-08 | Matsushita Electric Ind Co Ltd | ステッピングモータの駆動制御装置 |
| JPH0894653A (ja) * | 1994-09-26 | 1996-04-12 | Yazaki Corp | 針式表示装置 |
| JPH09182497A (ja) * | 1995-12-22 | 1997-07-11 | Fujitsu Ltd | ステッピングモータの駆動制御装置 |
| JP2002044995A (ja) * | 2000-07-27 | 2002-02-08 | Canon Inc | ステップモータ駆動装置とレンズ移動装置 |
| JP2002044994A (ja) * | 2000-07-25 | 2002-02-08 | Canon Electronics Inc | ステッピングモータ駆動装置 |
| JP2003304698A (ja) * | 2002-04-10 | 2003-10-24 | Toshiba Corp | 制御装置、駆動装置、撮像装置及びこれらの方法 |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4910706A (en) * | 1972-09-11 | 1990-03-20 | Hyatt Gilbert P | Analog memory for storing digital information |
| JP2740643B2 (ja) | 1994-09-20 | 1998-04-15 | 松下電器産業株式会社 | ステッピングモータ駆動装置 |
| JP4165915B2 (ja) | 1996-09-20 | 2008-10-15 | 松下電器産業株式会社 | ステッピングモータ制御装置 |
-
2004
- 2004-12-16 JP JP2004364181A patent/JP4665507B2/ja active Active
-
2005
- 2005-12-14 US US11/302,188 patent/US7339342B2/en not_active Expired - Fee Related
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6335199A (ja) * | 1986-07-26 | 1988-02-15 | Canon Electronics Inc | ステツピングモ−タの駆動制御方式 |
| JPH0352599A (ja) * | 1989-07-19 | 1991-03-06 | Japan Servo Co Ltd | ２軸駆動方法 |
| JPH06189598A (ja) * | 1992-12-16 | 1994-07-08 | Matsushita Electric Ind Co Ltd | ステッピングモータの駆動制御装置 |
| JPH0894653A (ja) * | 1994-09-26 | 1996-04-12 | Yazaki Corp | 針式表示装置 |
| JPH09182497A (ja) * | 1995-12-22 | 1997-07-11 | Fujitsu Ltd | ステッピングモータの駆動制御装置 |
| JP2002044994A (ja) * | 2000-07-25 | 2002-02-08 | Canon Electronics Inc | ステッピングモータ駆動装置 |
| JP2002044995A (ja) * | 2000-07-27 | 2002-02-08 | Canon Inc | ステップモータ駆動装置とレンズ移動装置 |
| JP2003304698A (ja) * | 2002-04-10 | 2003-10-24 | Toshiba Corp | 制御装置、駆動装置、撮像装置及びこれらの方法 |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009065770A (ja) * | 2007-09-06 | 2009-03-26 | Yokogawa Electric Corp | ステッピングモータ制御装置 |
| KR100850032B1 (ko) | 2008-02-28 | 2008-08-04 | 주식회사 다스텍 | 모터 충격 보호 장치 및 방법 |
| JP2012095521A (ja) * | 2010-09-30 | 2012-05-17 | Semiconductor Energy Lab Co Ltd | 電源回路 |
| CN108572610A (zh) * | 2017-03-13 | 2018-09-25 | 欧姆龙株式会社 | 评价系统、安全控制器、可读取记录媒体及评价方法 |
| CN112019104A (zh) * | 2020-08-26 | 2020-12-01 | 佛山市指擎科技有限公司 | 一种步进电机驱动方法、步进电机驱动装置及小型机械臂 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP4665507B2 (ja) | 2011-04-06 |
| US20060152187A1 (en) | 2006-07-13 |
| US7339342B2 (en) | 2008-03-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US7339342B2 (en) | Stepper motor controlling apparatus and pen recorder | |
| US10461675B2 (en) | Control device, optical apparatus, control method, and storage medium | |
| JP5656354B2 (ja) | 駆動装置 | |
| TW423207B (en) | Stepping motor controller and optical head driver | |
| WO2021112125A1 (ja) | ステッピングモータの駆動回路およびその駆動方法、それを用いた電子機器 | |
| US11251728B2 (en) | Driving circuit and driving method of stepping motor and electronic machine using the same | |
| JP6004830B2 (ja) | 制御装置およびステッピングモータの制御方法 | |
| JP3806985B2 (ja) | ステッピングモータ駆動装置 | |
| JP2001178193A (ja) | ステッピングモータ制御装置とそれを用いたレンズ装置 | |
| TW202143628A (zh) | 步進馬達的控制裝置 | |
| US11418138B2 (en) | Driving circuit and driving method of stepping motor and electronic machine using the same | |
| JP5025395B2 (ja) | 位置検出器の初期位置調整方法及びこの方法を用いた電動機駆動装置 | |
| US11183954B2 (en) | Motor driving device and control method thereof | |
| JP4959779B2 (ja) | ステッピングモータ駆動装置及び駆動方法 | |
| JP7005275B2 (ja) | モータ駆動装置、該モータ駆動装置を備えるモータシステム、及び撮像装置、モータ駆動方法 | |
| JP5467486B2 (ja) | ステッピングモータ制御装置 | |
| CN111614290A (zh) | 步进马达的驱动电路及其驱动方法、使用其的电子机器 | |
| JP2020198727A (ja) | モータ制御装置およびモータ制御方法、光学機器 | |
| JP7387268B2 (ja) | ステッピングモータの駆動回路、それを用いた電子機器 | |
| JP7467036B2 (ja) | モータ駆動装置およびその制御方法 | |
| US11695354B2 (en) | Motor control apparatus, optical apparatus, and robot manipulator apparatus | |
| JP2009011087A (ja) | ステッピングモータのマイクロステップ制御方法および電動装置 | |
| CN118199470A (zh) | 一种基于位置、速度反馈观测的伺服全闭环系统 | |
| JP2010063218A (ja) | サーボシステム | |
| JP2002044994A (ja) | ステッピングモータ駆動装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070712 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20100702 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100706 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100903 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20101214 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20101227 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140121 Year of fee payment: 3 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 4665507 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |