JP2011067013A - Motor control method for stepping motor, control device for the stepping motor, and stepping motor system - Google Patents

Motor control method for stepping motor, control device for the stepping motor, and stepping motor system Download PDF

Info

Publication number
JP2011067013A
JP2011067013A JP2009215581A JP2009215581A JP2011067013A JP 2011067013 A JP2011067013 A JP 2011067013A JP 2009215581 A JP2009215581 A JP 2009215581A JP 2009215581 A JP2009215581 A JP 2009215581A JP 2011067013 A JP2011067013 A JP 2011067013A
Authority
JP
Japan
Prior art keywords
stepping motor
coordinate
coordinates
pulse
pulses
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.)
Pending
Application number
JP2009215581A
Other languages
Japanese (ja)
Inventor
Mitsutoshi Ashida
光利 芦田
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.)
Tokyo Electron Ltd
Original Assignee
Tokyo Electron 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 Tokyo Electron Ltd filed Critical Tokyo Electron Ltd
Priority to JP2009215581A priority Critical patent/JP2011067013A/en
Priority to PCT/JP2010/065031 priority patent/WO2011033940A1/en
Publication of JP2011067013A publication Critical patent/JP2011067013A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • 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
    • H02P8/00Arrangements for controlling dynamo-electric motors rotating step by step
    • H02P8/04Arrangements for starting
    • H02P8/08Determining position before starting
    • 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
    • H02P8/00Arrangements for controlling dynamo-electric motors rotating step by step
    • H02P8/14Arrangements for controlling speed or speed and torque

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Control Of Stepping Motors (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a control method for a stepping motor that allows a stepping motor to rotate from a current coordinate to a target coordinate in a short period of time, even if the target coordinate is changed little at a time. <P>SOLUTION: A coordinate prior to the start of rotation of a stepping motor and a first number of pulses required for rotating the stepping motor from the coordinate before the start of rotation to a target coordinate are acquired; the total number of pulses outputted from the start of rotation of the stepping motor is acquired so as to set it as a second number of pulses; the second number of pulses is subtracted from the first number of pulses so as to acquire a third number of pulses required for making the stepping motor reach the target coordinate; then, a fourth number of pulses required by the time the stepping motor is stopped from the current speed is acquired; and it is determined whether to accelerate or decelerate the stepping motor from the current speed or to maintain the maximum speed, in order to rotate the stepping motor from the current coordinate to the target coordinate, on the basis of the third number of pulses and the fourth number of pulses. <P>COPYRIGHT: (C)2011,JPO&INPIT

Description

この発明はステッピングモータの制御方法、ステッピングモータの制御装置及びステッピングモータシステムに関する。   The present invention relates to a stepping motor control method, a stepping motor control device, and a stepping motor system.

モータを使用して、回転体を目標回転角まで回転させる場合、以下の手法が考えられる。   When using a motor to rotate a rotating body to a target rotation angle, the following methods are conceivable.

(サーボモータを使用する場合)
エンコーダでモータ軸の回転角を検出し、検出された回転角をコントローラやドライバへフィードバックし、フィードバックされた回転角を確認しながらモータ回転速度の調整を行い、モータ軸を目標の回転角まで回転させる。
(When using a servo motor)
The encoder detects the rotation angle of the motor shaft, feeds back the detected rotation angle to the controller and driver, adjusts the motor rotation speed while checking the feedback rotation angle, and rotates the motor shaft to the target rotation angle. Let

(ステッピングモータを使用する場合)
モータ軸を目標座標として与えられた目標の回転角まで回転させるパルスを生成してドライバを駆動し、モータ軸を目標の回転角まで回転させる。
(When using a stepping motor)
A pulse for rotating the motor shaft to the target rotation angle given as the target coordinates is generated to drive the driver, and the motor shaft is rotated to the target rotation angle.

サーボモータ、及びステッピングモータの制御方法は、例えば、特許文献1、2に記載されている。   The servo motor and stepping motor control methods are described in, for example, Patent Documents 1 and 2.

しかしながら、サーボモータは、エンコーダで検出された回転角等を、コントローラやドライバへフィードバックする。このため、フィードバックを常に確認しなければならず、細かな位置合わせには多くの演算が必要となる。   However, the servo motor feeds back the rotation angle detected by the encoder to the controller or driver. For this reason, feedback must always be confirmed, and many calculations are required for fine alignment.

対して、ステッピングモータは、1パルスで一定の角度(ステップ角)だけ回転するように構成される。このため、開ループ制御することができ、開ループ制御した場合には高速の位置合わせが可能となる。   On the other hand, the stepping motor is configured to rotate by a certain angle (step angle) with one pulse. For this reason, open-loop control can be performed, and high-speed alignment is possible when open-loop control is performed.

特開2004−282972号公報JP 2004-282972 A 特開2007−185052号公報JP 2007-185052 A

しかしながら、ステッピングモータは、目標座標(目標の回転角)を一度指示すると、目標座標までの回転が終了するまで、新たな目標座標を発行することができない。これは、CPUが目標座標の発行だけでなく、加速指示及び減速指示をも発行しているためである。即ち、CPUは、目標座標を発行した後、ステッピングモータが目標座標に達するように加速を終了させるタイミングの演算と減速を開始させるタイミングの演算を予め行って発行している。このような演算をCPUが行っているため、目標座標までの回転を一旦終了させないと、CPUは新たな目標座標に対する演算を予め行うことができない。   However, once the stepping motor indicates the target coordinate (target rotation angle), it cannot issue a new target coordinate until the rotation to the target coordinate is completed. This is because the CPU issues not only a target coordinate but also an acceleration instruction and a deceleration instruction. In other words, after issuing the target coordinates, the CPU issues and calculates in advance the timing for ending acceleration and the timing for starting deceleration so that the stepping motor reaches the target coordinates. Since such a calculation is performed by the CPU, the CPU cannot perform a calculation for a new target coordinate in advance unless the rotation to the target coordinate is once ended.

このため、目標座標を小刻みに変更する場合には、余分な加速及び減速時間を要し、位置合わせに余分な時間がかかってしまう、という事情がある。   For this reason, when the target coordinates are changed in small increments, extra acceleration and deceleration times are required, and extra time is required for alignment.

この発明は、上記事情に鑑みて為されたもので、目標座標を小刻みに変更しても、ステッピングモータを目標座標まで短時間で回転させることが可能なステッピングモータの制御方法、ステッピングモータの制御装置及びステッピングモータシステムを提供する。   The present invention has been made in view of the above circumstances. A stepping motor control method and a stepping motor control capable of rotating a stepping motor to a target coordinate in a short time even if the target coordinate is changed in small increments. An apparatus and a stepping motor system are provided.

上記課題を解決するため、この発明の第1の態様に係るステッピングモータの制御方法は、ステッピングモータを、出力したパルスに従って目標座標まで回転させるステッピングモータの制御方法であって、前記ステッピングモータの回転開始前の座標を取得し、前記ステッピングモータを前記回転開始前の座標から前記目標座標まで回転させるために必要な第1のパルス数を取得し、前記ステッピングモータの回転開始から出力した累計パルス数を取得して第2のパルス数とし、前記第1のパルス数から前記第2のパルス数を減算することで、目標座標に到達させるために必要な第3のパルス数を取得し、前記ステッピングモータが現在の速度から停止するまでに必要な第4のパルス数を取得し、前記第3のパルス数及び前記第4のパルス数に基づいて、前記ステッピングモータを前記目標座標に向けて回転させるために、前記ステッピングモータを現在の速度から加速させるか、減速させるか、又は最高速度を維持させるかを判断する。   In order to solve the above-mentioned problem, a stepping motor control method according to a first aspect of the present invention is a stepping motor control method for rotating a stepping motor to a target coordinate according to an output pulse, wherein the stepping motor is rotated. The coordinates before the start are acquired, the first number of pulses necessary for rotating the stepping motor from the coordinates before the start of rotation to the target coordinates is acquired, and the cumulative number of pulses output from the start of the rotation of the stepping motor To obtain the second pulse number, and subtract the second pulse number from the first pulse number to obtain the third pulse number necessary to reach the target coordinate, and the stepping A fourth pulse number required until the motor stops from the current speed is acquired, and the third pulse number and the fourth pulse are acquired. Based on, the stepping motor to rotate toward the target coordinates, or to accelerate the stepping motor from the current speed, or decelerating, or the determining to maintain the maximum speed.

この発明の第2の態様に係るステッピングモータの制御装置は、ステッピングモータを、出力したパルスに従って目標座標まで回転させるステッピングモータの制御装置であって、前記ステッピングモータの回転開始前の座標を取得する手段と、前記回転開始前の座標から前記目標座標まで到達させるために必要な第1のパルス数を取得する手段と、回転開始後に出力した累計パルス数である第2のパルス数を取得する手段と、前記第1のパルス数から前記第2のパルス数を減算することで、目標座標に到達させるために必要な第3のパルス数を取得する手段と、現在の速度から停止するまでに必要な第4のパルス数を取得する手段と、前記第3のパルス数及び前記第4のパルス数に基づいて、前記ステッピングモータを前記目標座標に向けて回転させるために、前記ステッピングモータを現在の速度から加速させるか、減速させるか、又は最高速度を維持させるかを判断する手段と、を備える。   A stepping motor control device according to a second aspect of the present invention is a stepping motor control device that rotates a stepping motor to a target coordinate according to an output pulse, and acquires coordinates before the rotation of the stepping motor is started. Means for obtaining a first pulse number required to reach the target coordinate from the coordinates before the start of rotation, and means for obtaining a second pulse number that is the cumulative number of pulses output after the start of rotation. And means for obtaining the third number of pulses required to reach the target coordinates by subtracting the second number of pulses from the first number of pulses, and necessary for stopping from the current speed. A step of obtaining the fourth pulse number, and directing the stepping motor to the target coordinate based on the third pulse number and the fourth pulse number. Provided in order to rotate, or to accelerate the stepping motor from the current speed, or slowing, or means for determining to maintain the maximum speed, the.

この発明の第3の態様に係るステッピングモータシステムは、ステッピングモータと、目標座標を発行するとともに、前記目標座標を発行した後に前記目標座標とは異なる新たな目標座標を発行することが可能な演算装置と、前記目標座標、及び前記新たな目標座標を受け、前記ステッピングモータを回転させる駆動パルスを生成するパルスジェネレータと、前記駆動パルスを受け、前記ステッピングモータを回転させるドライバと、を備え、前記パルスジェネレータが、前記目標座標、及び前記新たな目標座標を受け、加速指示及び減速指示を発行するコントローラと、前記加速指示及び減速指示を受け、速度データを生成する速度カウンタと、ステッピングモータの座標を記憶する領域と、回転開始から出力した累計パルス数を記憶する領域を含み、前記速度データを受けて前記ステッピングモータを回転させる駆動パルスを生成する座標カウンタと、前記加速指示及び減速指示を受け、前記ステッピングモータを加速させている間、前記駆動パルスを、前記駆動パルスが生成されるごとに加算して蓄積し、前記蓄積された駆動パルス数から、前記ステッピングモータを減速させている間、前記駆動パルスを、前記駆動パルスが生成されるごとに減算する減速時座標変化量カウンタと、を含み、前記コントローラが、前記ステッピングモータの回転開始前の座標を前記座標カウンタから取得し、前記ステッピングモータを前記回転開始前の座標から前記目標座標まで回転させるために必要な第1のパルス数を取得し、前記ステッピングモータの回転開始から出力した累計パルス数を前記座標カウンタから取得して第2のパルス数とし、前記第1のパルス数から前記第2のパルス数を減算することで、目標座標に到達させるために必要な第3のパルス数を取得し、前記ステッピングモータが現在の速度から停止するまでに必要な第4のパルス数を前記減速時座標変化量カウンタから取得し、前記第3のパルス数及び前記第4のパルス数に基づいて、前記ステッピングモータを前記目標座標に向けて回転させるために、前記ステッピングモータを現在の速度から加速させるか、減速させるか、又は最高速度を維持させるかを判断する。   A stepping motor system according to a third aspect of the present invention is capable of issuing a stepping motor and a target coordinate and issuing a new target coordinate different from the target coordinate after issuing the target coordinate. An apparatus, a pulse generator that receives the target coordinates and the new target coordinates, and generates a driving pulse that rotates the stepping motor; and a driver that receives the driving pulse and rotates the stepping motor, A pulse generator that receives the target coordinates and the new target coordinates and issues an acceleration instruction and a deceleration instruction, a speed counter that receives the acceleration instructions and a deceleration instruction and generates speed data, and the coordinates of the stepping motor And the cumulative number of pulses output from the start of rotation A coordinate counter that generates a drive pulse that rotates the stepping motor in response to the speed data, and receives the acceleration instruction and the deceleration instruction and accelerates the stepping motor. Deceleration that adds and accumulates every time a drive pulse is generated and subtracts the drive pulse every time the drive pulse is generated while decelerating the stepping motor from the accumulated number of drive pulses A time coordinate change amount counter, wherein the controller obtains coordinates before starting the rotation of the stepping motor from the coordinate counter, and rotates the stepping motor from the coordinates before starting the rotation to the target coordinates. Accumulated pulses output from the start of rotation of the stepping motor after obtaining the required number of first pulses Is obtained from the coordinate counter as the second pulse number, and the third pulse number necessary to reach the target coordinate is obtained by subtracting the second pulse number from the first pulse number. Then, the fourth pulse number required until the stepping motor stops from the current speed is acquired from the deceleration coordinate change amount counter, and based on the third pulse number and the fourth pulse number, In order to rotate the stepping motor toward the target coordinates, it is determined whether to accelerate, decelerate, or maintain the maximum speed from the current speed.

この発明によれば、目標座標を小刻みに変更しても、ステッピングモータを目標座標まで短時間で回転させることが可能なステッピングモータの制御方法、ステッピングモータの制御装置及びステッピングモータシステムを提供できる。   According to the present invention, it is possible to provide a stepping motor control method, a stepping motor control device, and a stepping motor system that can rotate the stepping motor to the target coordinates in a short time even if the target coordinates are changed in small increments.

この発明の一実施形態に係るステッピングモータの制御方法を適用することが可能なステッピングモータシステムの一例を示すブロック図The block diagram which shows an example of the stepping motor system which can apply the control method of the stepping motor which concerns on one Embodiment of this invention 図1に示すパルスジェネレータ3の一例を示すブロック図Block diagram showing an example of the pulse generator 3 shown in FIG. この発明の一実施形態に係るステッピングモータの制御方法による速度パターン制御例を示す図The figure which shows the example of speed pattern control by the control method of the stepping motor which concerns on one Embodiment of this invention この発明の一実施形態に係るステッピングモータの制御方法による速度パターン制御例を示す図The figure which shows the example of speed pattern control by the control method of the stepping motor which concerns on one Embodiment of this invention この発明の一実施形態に係るステッピングモータの制御方法による速度パターン制御例を示す図The figure which shows the example of speed pattern control by the control method of the stepping motor which concerns on one Embodiment of this invention 参考例に係るステッピングモータの制御方法による速度パターン制御例を示す図The figure which shows the example of speed pattern control by the control method of the stepping motor which concerns on a reference example

以下、この発明の一実施形態を、図面を参照して説明する。なお、全図にわたり、共通の部分には共通の参照符号を付す。   Hereinafter, an embodiment of the present invention will be described with reference to the drawings. Note that common parts are denoted by common reference numerals throughout the drawings.

また、この説明において、「座標」の語については、単に「座標」と記した場合は「絶対座標」を意味し、「相対座標」と特記した場合は「相対座標」を意味する。   In this description, the term “coordinate” means “absolute coordinate” when simply written as “coordinate”, and means “relative coordinate” when specially mentioned as “relative coordinate”.

(ステッピングモータシステム)
図1は、この発明の一実施形態に係るステッピングモータの制御方法を適用することが可能なステッピングモータシステムの一例を示すブロック図である。
(Stepping motor system)
FIG. 1 is a block diagram showing an example of a stepping motor system to which a stepping motor control method according to an embodiment of the present invention can be applied.

図1に示すように、ステッピングモータシステムは、ステッピングモータ1と、目標座標を発行するとともに、目標座標を発行した後に目標座標とは異なる新たな目標座標を発行することが可能な演算装置(CPU)2と、目標座標、及び新たな目標座標を受け、ステッピングモータ1を回転させる駆動パルスを生成するパルスジェネレータ3と、駆動パルスを受け、ステッピングモータ1を回転させるドライバ4と、を備えている。ドライバ4は、例えば、駆動パルスが与えられるたびに、ステッピングモータ1を一定の角度(ステップ角)だけ回転させる。   As shown in FIG. 1, the stepping motor system issues a target coordinate with the stepping motor 1 and an arithmetic device (CPU that can issue a new target coordinate different from the target coordinate after issuing the target coordinate. ) 2, a target coordinate and a new target coordinate, and a pulse generator 3 that generates a driving pulse that rotates the stepping motor 1, and a driver 4 that receives the driving pulse and rotates the stepping motor 1. . For example, the driver 4 rotates the stepping motor 1 by a certain angle (step angle) every time a driving pulse is given.

このように構成されるステッピングモータシステムにおいて、本一実施形態においては、パルスジェネレータ3を以下のように構成する。   In the stepping motor system configured as described above, in the present embodiment, the pulse generator 3 is configured as follows.

(パルスジェネレータ)
図2は、パルスジェネレータ3の一例を示すブロック図である。
(Pulse generator)
FIG. 2 is a block diagram illustrating an example of the pulse generator 3.

図2に示すように、一例に係るパルスジェネレータ3は、コントローラ31、速度カウンタ32、座標カウンタ33、及び減速時座標変化量カウンタ34、回転方向信号35、加減速指示信号36、速度指示値37、駆動パルス38を含んで構成される。   As shown in FIG. 2, the pulse generator 3 according to an example includes a controller 31, a speed counter 32, a coordinate counter 33, a deceleration coordinate change amount counter 34, a rotation direction signal 35, an acceleration / deceleration instruction signal 36, and a speed instruction value 37. , Including a drive pulse 38.

コントローラ31は、演算装置2から目標座標、及び新たな目標座標を受け、加速指示、減速指示、または速度維持指示を加減速指示信号36として発行する。   The controller 31 receives the target coordinate and the new target coordinate from the arithmetic device 2 and issues an acceleration instruction, a deceleration instruction, or a speed maintenance instruction as the acceleration / deceleration instruction signal 36.

速度カウンタ32は、加減速指示信号36を受け、速度指示値37を生成する。   The speed counter 32 receives the acceleration / deceleration instruction signal 36 and generates a speed instruction value 37.

座標カウンタ33は、絶対座標レジスタ61、回転開始座標レジスタ62、相対座標レジスタ63を含む。   The coordinate counter 33 includes an absolute coordinate register 61, a rotation start coordinate register 62, and a relative coordinate register 63.

絶対座標レジスタ61は例えば14ビット長である。   The absolute coordinate register 61 is, for example, 14 bits long.

回転開始座標レジスタ62は例えば14ビット長である。   The rotation start coordinate register 62 is, for example, 14 bits long.

相対座標レジスタ63は、上位部63aと下位部63bからなる。   The relative coordinate register 63 includes an upper part 63a and a lower part 63b.

相対座標レジスタ63は例えば36ビット長であり、上位部63aは例えば14ビット、下位部63bは例えば22ビットである。   The relative coordinate register 63 is, for example, 36 bits long, the upper part 63a is, for example, 14 bits, and the lower part 63b is, for example, 22 bits.

ステッピングモータ1が停止中で新たな回転を開始する前に、相対座標レジスタ63を上位部、下位部ともにゼロにリセットする。
また、停止中の現在座標である絶対座標レジスタ61の値を回転開始座標レジスタ62に保存する。
Before the stepping motor 1 is stopped and starts a new rotation, the relative coordinate register 63 is reset to zero for both the upper part and the lower part.
Further, the value of the absolute coordinate register 61 that is the current coordinate being stopped is stored in the rotation start coordinate register 62.

座標カウンタ33は、クロック(図示せず)に同期して、速度指示値37を相対座標レジスタ63の現在値に加算し相対座標レジスタ63を更新する。上位部63aの最下位ビットをステッピングモータ1を回転させる駆動パルス38として使用する。   The coordinate counter 33 adds the speed instruction value 37 to the current value of the relative coordinate register 63 and updates the relative coordinate register 63 in synchronization with a clock (not shown). The least significant bit of the upper part 63a is used as a drive pulse 38 for rotating the stepping motor 1.

相対座標レジスタ上位部63aの値が変化した時、絶対座標レジスタ61を更新し最新の状態に保つ。   When the value of the relative coordinate register upper part 63a changes, the absolute coordinate register 61 is updated to keep the latest state.

具体的には、ステッピングモータ1の回転方向に応じ、回転開始座標レジスタ62の値に相対座標レジスタ上位部63aの値を加算または減算することで、絶対座標の更新値を得る。   Specifically, the absolute coordinate update value is obtained by adding or subtracting the value of the relative coordinate register upper part 63a to the value of the rotation start coordinate register 62 in accordance with the rotation direction of the stepping motor 1.

減速時座標変化量カウンタ34は、コントローラ31からの加速指示及び減速指示を受け、ステッピングモータ1を加速させている間、駆動パルスを、駆動パルスが生成されるごとに加算して蓄積する。さらに、減速時座標変化量カウンタ34は、ステッピングモータ1を減速させている間、蓄積された駆動パルス数から駆動パルスを、駆動パルスが生成されるごとに減算する。このような加速時に加算して蓄積され、減速時に減算される駆動パルス数は、ステッピングモータ1が、現在の速度から停止するまでに必要なパルス数に等しい。   The coordinate change counter 34 at the time of deceleration receives the acceleration instruction and the deceleration instruction from the controller 31 and accumulates the drive pulse every time the drive pulse is generated while the stepping motor 1 is accelerated. Further, the deceleration coordinate change amount counter 34 subtracts the driving pulse from the accumulated number of driving pulses every time the driving pulse is generated while the stepping motor 1 is decelerated. The number of drive pulses added and accumulated during acceleration and subtracted during deceleration is equal to the number of pulses required until the stepping motor 1 stops from the current speed.

台形駆動などでは、速度ゼロから最高速度Vpeakに達するまでに必要なパルス数(加速パルス数)Paccが、最高速度Vpeakから速度ゼロに達するまでに必要なパルス数(減速パルス数)Pdecと同じである、と仮定できる。この場合、加速パルス数Paccから、減速時において、駆動パルスが一回出力されるたびに一つずつパルス数を減算していくと、ステッピングモータ1が停止するまでに必要な残りのパルス数を知ることができる。   In trapezoidal driving, the number of pulses (acceleration pulse) Pacc required to reach the maximum speed Vpeak from the zero speed is the same as the number of pulses (deceleration pulse number) Pdec required to reach the zero speed from the maximum speed Vpeak. It can be assumed that there is. In this case, if the number of pulses is subtracted from the acceleration pulse number Pacc one by one each time a drive pulse is output during deceleration, the remaining number of pulses required until the stepping motor 1 stops is obtained. I can know.

減速時座標変化量カウンタ34は、その値を、速度指示値37を積算して得るようにこ構成することも可能である。   The coordinate change counter 34 at the time of deceleration can be configured to obtain the value by integrating the speed instruction value 37.

具体的には、減速時座標変化量カウンタ34のビット長を相対座標レジスタ63と等しくする。減速時座標変化量カウンタ34は上位部と下位部からなり、上位部のビット長を相対座標レジスタ上位部63aのビット長と等しくする。   Specifically, the bit length of the coordinate change counter 34 during deceleration is made equal to the relative coordinate register 63. The deceleration coordinate change amount counter 34 includes an upper part and a lower part, and the bit length of the upper part is made equal to the bit length of the relative coordinate register upper part 63a.

ステッピングモータ1が停止中で新たな回転を開始する前に、減速時座標変化量カウンタ34ゼロにリセットする。   Before the stepping motor 1 is stopped and starts a new rotation, the coordinate change counter 34 during deceleration is reset to zero.

加減速指示信号36が加速指示の場合、速度指示値37を減速時座標変化量カウンタ34の現在値に加算して積算する。   When the acceleration / deceleration instruction signal 36 is an acceleration instruction, the speed instruction value 37 is added to the current value of the deceleration coordinate change amount counter 34 and integrated.

加減速指示信号36が減速指示の場合、速度指示値37を減速時座標変化量カウンタ34の現在値から減算して積算する。   If the acceleration / deceleration instruction signal 36 is a deceleration instruction, the speed instruction value 37 is subtracted from the current value of the deceleration coordinate change amount counter 34 and integrated.

加減速指示信号36が速度維持指示の場合、積算しない。   When the acceleration / deceleration instruction signal 36 is a speed maintenance instruction, no integration is performed.

回転方向信号35はドライバ4に対し回転方向を指示する。   The rotation direction signal 35 instructs the driver 4 on the rotation direction.

コントローラ31は、停止中に、目標座標(D1)を受け付けた後、目標座標(D1)から、停止中の現在座標(S1)を減算し、目標座標(D1)まで回転させるために必要な第1のパルス数(P1)を演算する。   The controller 31 receives the target coordinate (D1) during the stop, and then subtracts the current coordinate (S1) during the stop from the target coordinate (D1) and rotates it to the target coordinate (D1). The number of pulses of 1 (P1) is calculated.

コントローラ31は、回転開始後、第1のパルス数(P1)から、回転開始から出力した累計の駆動パルス数(第2のパルス数、P2)を常に減算することで、ステッピングモータ1を回転中の現在座標(C1)から目標座標(D1)まで回転させるために必要な第3のパルス数(P3)を常に取得する。   The controller 31 is rotating the stepping motor 1 by always subtracting the cumulative drive pulse number (second pulse number, P2) output from the start of rotation from the first pulse number (P1) after starting rotation. The third pulse number (P3) necessary for rotating from the current coordinate (C1) to the target coordinate (D1) is always acquired.

回転開始から出力した累計の駆動パルス数(第2のパルス数、P2)は相対座標レジスタ上位部36aに保存されている。   The cumulative drive pulse number (second pulse number, P2) output from the start of rotation is stored in the relative coordinate register upper part 36a.

この第3のパルス数(P3)と減速時座標変化量カウンタの値(P4)を比較することで、ステッピングモータの動作を、加速、減速、最高速度維持の3種から最適な動作を選択する。   By comparing the third pulse number (P3) with the coordinate change amount counter value (P4) during deceleration, the optimum operation of the stepping motor is selected from the three types of acceleration, deceleration and maximum speed maintenance. .

具体的な判断の一例は、第3のパルス数(P3)から減速時座標変化量カウンタ(P4)を減算した値が0より大きい場合、ステッピングモータ1が回転中の現在座標(C1)から減速しても目標座標(D1)に到達しないので、コントローラ31は、ステッピングモータを加速させる、又は最高速度を維持させるように制御する。   An example of a specific determination is that if the value obtained by subtracting the deceleration coordinate change counter (P4) from the third pulse number (P3) is greater than 0, the stepping motor 1 decelerates from the current coordinates (C1) during rotation. Even so, since the target coordinate (D1) is not reached, the controller 31 controls the stepping motor to be accelerated or to maintain the maximum speed.

また、第3のパルス数(P3)から減速時座標変化量カウンタ(P4)を減算した値が0以下の場合、ステッピングモータ1が、回転中の現在座標(C1)から減速すると目標座標(D1)に到達する、又は超えるので、コントローラ31は、ステッピングモータ1を減速させるように制御する。   Further, when the value obtained by subtracting the deceleration coordinate change amount counter (P4) from the third pulse number (P3) is 0 or less, the target coordinate (D1) when the stepping motor 1 decelerates from the rotating current coordinate (C1). ) Is reached or exceeded, the controller 31 controls the stepping motor 1 to decelerate.

さらに、コントローラ31は、回転中に、新たな目標座標(D2)を受け付けた後に、新たな目標座標(D2)から回転開始前の座標(S1)を減算し、新たな目標座標(D2)まで回転させるために必要な第5のパルス数(P5)を計算し、前記第1のパルス数(P1)と置き換える。したがって、コントローラ31は、新たな目標座標を受け付けた後も、ステッピングモータ1を新たな目標座標(D2)まで回転させるために、加速、減速、最高速度維持の3種から最適な動作を選択できる。   Furthermore, after receiving the new target coordinate (D2) during the rotation, the controller 31 subtracts the coordinate (S1) before the rotation start from the new target coordinate (D2) to the new target coordinate (D2). A fifth pulse number (P5) necessary for rotation is calculated and replaced with the first pulse number (P1). Therefore, the controller 31 can select an optimum operation from the three types of acceleration, deceleration, and maximum speed maintenance to rotate the stepping motor 1 to the new target coordinate (D2) even after receiving the new target coordinate. .

以上の説明では、パルス数を比較してステッピングモータの動作を選択したが、目標座標と推定停止座標を比較して動作を選択することも可能である。   In the above description, the operation of the stepping motor is selected by comparing the number of pulses, but it is also possible to select the operation by comparing the target coordinates and the estimated stop coordinates.

コントローラ31は、停止中に、目標座標(D1)を受け付けた後、目標座標(D1)と停止中の現在座標(S1)から、回転方向信号35、加減速指示信号36その他を設定して回転動作を開始する。   The controller 31 receives the target coordinate (D1) during the stop, and then sets the rotation direction signal 35, the acceleration / deceleration instruction signal 36 and others from the target coordinate (D1) and the current coordinate (S1) during the stop. Start operation.

コントローラ31は、回転開始後、下記の式で推定停止座標(S2)を算出する。   After starting the rotation, the controller 31 calculates the estimated stop coordinate (S2) using the following equation.

ステッピングモータ1が正回転の場合:
推定停止座標(S2)=(絶対座標レジスタ61の値)+(減速時座標変化量カウンタ34の値)
ステッピングモータ1が逆回転の場合:
推定停止座標(S2)=(絶対座標レジスタ61の値)−(減速時座標変化量カウンタ34の値)
目標座標(D1)と推定停止座標(S2)を比較することで、ステッピングモータの動作を、加速、減速、最高速度維持の3種から最適な動作を選択する。
When the stepping motor 1 is rotating forward:
Estimated stop coordinate (S2) = (value of absolute coordinate register 61) + (value of coordinate change counter 34 during deceleration)
When the stepping motor 1 is rotating in reverse:
Estimated stop coordinate (S2) = (value of absolute coordinate register 61) − (value of coordinate change counter 34 during deceleration)
By comparing the target coordinates (D1) and the estimated stop coordinates (S2), the optimum operation of the stepping motor is selected from the three types of acceleration, deceleration, and maximum speed maintenance.

判断の一例は、回転方向が正であり、推定停止座標(S2)が目標座標(D1)より小さい場合、ステッピングモータ1が回転中の現在座標(C1)から減速しても目標座標(D1)に到達しないので、コントローラ31は、ステッピングモータを加速させる、又は最高速度を維持させるように制御する。   As an example of the determination, when the rotation direction is positive and the estimated stop coordinate (S2) is smaller than the target coordinate (D1), the target coordinate (D1) even if the stepping motor 1 decelerates from the current coordinate (C1) during rotation. Therefore, the controller 31 controls the stepping motor to accelerate or maintain the maximum speed.

回転方向が正であり、推定停止座標(S2)が目標座標(D1)以上の値の場合、ステッピングモータ1が、回転中の現在座標(C1)から減速すると目標座標(D1)に到達する、又は超えるので、コントローラ31は、ステッピングモータ1を減速させるように制御する。   When the rotation direction is positive and the estimated stop coordinate (S2) is a value greater than or equal to the target coordinate (D1), the stepping motor 1 reaches the target coordinate (D1) when decelerated from the current coordinate (C1) during rotation. Alternatively, the controller 31 controls the stepping motor 1 to decelerate.

更にコントローラ31は、回転中に、新たな目標座標(D2)を受け付けた場合、直ちに、目標座標(D1)を新たな目標座標(D2)で置き換える。したがって、コントローラ31は、新たな目標座標を受け付けた後も、ステッピングモータ1を新たな目標座標(D2)まで回転させるために、加速、減速、最高速度維持の3種から最適な動作を選択できる。   Furthermore, when the controller 31 receives a new target coordinate (D2) during rotation, the controller 31 immediately replaces the target coordinate (D1) with the new target coordinate (D2). Therefore, the controller 31 can select an optimum operation from the three types of acceleration, deceleration, and maximum speed maintenance to rotate the stepping motor 1 to the new target coordinate (D2) even after receiving the new target coordinate. .

以下、具体的な制御例とともに、より詳細に説明する。   Hereinafter, it demonstrates in detail with a specific control example.

一例に係るパルスジェネレータ3は、新たな目標座標を、加速時、最高速度時、及び減速時のいずれの場合においても受け付けることができる。これら3つの場合において、それぞれ制御例を説明する。   The pulse generator 3 according to an example can accept a new target coordinate in any case of acceleration, maximum speed, and deceleration. A control example will be described for each of these three cases.

(制御例1:加速時に新たな目標座標を受け付けた場合)
1.1減速しても新たな目標座標に到達しない場合
この場合には、コントローラ31は、新たな目標座標を受け付けた際の座標から、ステッピングモータ1を、新たな目標座標に到達するように加速させる。
(Control example 1: When new target coordinates are accepted during acceleration)
1.1 When the new target coordinates are not reached even after decelerating In this case, the controller 31 causes the stepping motor 1 to reach the new target coordinates from the coordinates when the new target coordinates are received. Accelerate.

図3Aは、加速後、最高速度に達することなく、新たな目標座標に到達する場合の制御例を示す。   FIG. 3A shows an example of control when reaching a new target coordinate without reaching the maximum speed after acceleration.

図3Aに示すように、コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1の加速を続け、加速の途中で、新たな目標座標に到達するように減速に切り換える。   As shown in FIG. 3A, after receiving a new target coordinate, the controller 31 continues to accelerate the stepping motor 1 and switches to deceleration so as to reach the new target coordinate during the acceleration.

図3Bは、加速後、最高速度Vpeakに達してから、新たな目標座標に到達する場合の制御例を示す。   FIG. 3B shows an example of control when reaching a new target coordinate after reaching the maximum speed Vpeak after acceleration.

図3Bに示すように、コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1の加速を最高速度Vpeakに達するまで続け、最高速度Vpeakから、新たな目標座標に到達するように減速に切り換える。   As shown in FIG. 3B, after receiving the new target coordinates, the controller 31 continues the acceleration of the stepping motor 1 until reaching the maximum speed Vpeak, and decelerates from the maximum speed Vpeak to reach the new target coordinates. Switch.

1.2減速すると新たな目標座標に到達する、又は超える場合
この場合には、コントローラ31は、新たな目標座標を受け付けた際の座標から、ステッピングモータ1を、新たな目標座標に到達するように減速させる。
1.2 New target coordinates are reached or decelerated when decelerating In this case, the controller 31 causes the stepping motor 1 to reach the new target coordinates from the coordinates when the new target coordinates are received. To slow down.

図3Cは、減速させると、丁度、新たな目標座標に到達する場合の制御例を示す。   FIG. 3C shows an example of control in a case where the new target coordinates are reached just after decelerating.

図3Cに示すように、コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1を、加速の途中で、新たな目標座標に到達するように減速に切り換える。   As shown in FIG. 3C, after receiving the new target coordinates, the controller 31 switches the stepping motor 1 to deceleration so as to reach the new target coordinates during the acceleration.

図3D及び図3Eは、減速させると、新たな目標座標を超える場合の制御例を示す。   FIG. 3D and FIG. 3E show control examples when the new target coordinates are exceeded when decelerated.

コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1を、加速の途中で減速に切り換える。ステッピングモータ1が停止した後、コントローラ31は、例えば、回転方向信号を反転させた後、駆動パルスを生成して、ステッピングモータ1を逆回転させ、ステッピングモータ1を新たな目標座標に到達するように加速及び減速(図3D)、又は最高速度Vpeakまで加速させた後に減速させる(図3E)。   After receiving the new target coordinates, the controller 31 switches the stepping motor 1 to deceleration during acceleration. After the stepping motor 1 stops, for example, the controller 31 inverts the rotation direction signal, generates a drive pulse, reversely rotates the stepping motor 1, and reaches the new target coordinates. Accelerate and decelerate (FIG. 3D), or accelerate to the maximum speed Vpeak and then decelerate (FIG. 3E).

(制御例2:最高速度時に新たな目標座標を受け付けた場合)
2.1減速しても新たな目標座標に到達しない場合
この場合には、コントローラ31は、新たな目標座標を受け付けた際の座標から、ステッピングモータ1を、新たな目標座標に到達するように最高速度で運転する。
(Control example 2: When a new target coordinate is received at the maximum speed)
2.1 When the new target coordinates are not reached even after decelerating In this case, the controller 31 causes the stepping motor 1 to reach the new target coordinates from the coordinates when the new target coordinates are received. Drive at maximum speed.

図4Aに示すように、コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1を最高速度Vpeakで続けて運転させ、最高速度Vpeakの途中で、新たな目標座標に到達するように減速に切り換える。   As shown in FIG. 4A, after receiving the new target coordinates, the controller 31 continuously operates the stepping motor 1 at the maximum speed Vpeak, and decelerates so as to reach the new target coordinates in the middle of the maximum speed Vpeak. Switch to.

2.2減速すると新たな目標座標に到達する、又は超える場合
この場合には、コントローラ31は、新たな目標座標を受け付けた際の座標から、ステッピングモータ1を、新たな目標座標に到達するように減速させる。
2.2 When the new target coordinates are reached or exceeded when decelerating In this case, the controller 31 causes the stepping motor 1 to reach the new target coordinates from the coordinates when the new target coordinates are received. To slow down.

図4Bは、減速させると、丁度、新たな目標座標に到達する場合の制御例を示す。   FIG. 4B shows an example of control in a case where a new target coordinate is reached when the vehicle is decelerated.

図4Bに示すように、コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1を、最高速度Vpeakから、新たな目標座標に到達するように減速に切り換える。   As shown in FIG. 4B, after receiving the new target coordinates, the controller 31 switches the stepping motor 1 from the maximum speed Vpeak to deceleration so as to reach the new target coordinates.

図4C及び図4Dは、減速させると、新たな目標座標を超える場合の制御例を示す。   FIG. 4C and FIG. 4D show a control example when the new target coordinates are exceeded when the vehicle is decelerated.

コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1を、最高速度Vpeakから減速に切り換える。ステッピングモータ1が停止した後、コントローラ31は、例えば、回転方向信号を反転させた後、駆動パルスを生成して、ステッピングモータ1を逆回転させ、ステッピングモータ1を新たな目標座標に到達するように加速及び減速(図4C)、又は最高速度Vpeakまで加速させた後に減速させる(図4D)。   After receiving the new target coordinates, the controller 31 switches the stepping motor 1 from the maximum speed Vpeak to deceleration. After the stepping motor 1 stops, for example, the controller 31 inverts the rotation direction signal, generates a drive pulse, reversely rotates the stepping motor 1, and reaches the new target coordinates. Accelerate and decelerate (FIG. 4C), or accelerate to the maximum speed Vpeak and then decelerate (FIG. 4D).

(制御例3:減速時に新たな目標座標を受け付けた場合)
3.1減速しても新たな目標座標に到達しない場合
この場合には、コントローラ31は、新たな目標座標を受け付けた際の座標から、ステッピングモータ1を、新たな目標座標に到達するように加速させる。
(Control example 3: When new target coordinates are received during deceleration)
3.1 When the new target coordinates are not reached even after deceleration In this case, the controller 31 causes the stepping motor 1 to reach the new target coordinates from the coordinates when the new target coordinates are received. Accelerate.

図5Aは、最高速度Vpeakに達することなく、新たな目標座標に到達する場合の制御例を示す。   FIG. 5A shows a control example in a case where a new target coordinate is reached without reaching the maximum speed Vpeak.

図5Aに示すように、コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1を減速から加速に切り換え、加速の途中で、新たな目標座標に到達するように減速に切り換える。   As shown in FIG. 5A, after receiving the new target coordinates, the controller 31 switches the stepping motor 1 from deceleration to acceleration, and switches to deceleration so as to reach the new target coordinates during the acceleration.

図5Bは、最高速度Vpeakに達した後、新たな目標座標に到達する場合の制御例を示す。   FIG. 5B shows a control example in a case where a new target coordinate is reached after reaching the maximum speed Vpeak.

図5Bに示すように、コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1を減速から加速に切り換え、加速を最高速度Vpeakに達するまで続ける。そして、最高速度Vpeakの途中で、新たな目標座標に到達するように減速に切り換える。   As shown in FIG. 5B, after receiving the new target coordinates, the controller 31 switches the stepping motor 1 from deceleration to acceleration and continues the acceleration until the maximum speed Vpeak is reached. Then, in the middle of the maximum speed Vpeak, switching to deceleration is performed so as to reach a new target coordinate.

3.2減速すると新たな目標座標に到達する、又は超える場合
この場合には、コントローラ31は、新たな目標座標を受け付けた際の座標から、ステッピングモータ1を、新たな目標座標に到達するように減速させる。
3.2 When a new target coordinate is reached or decelerated when decelerating In this case, the controller 31 causes the stepping motor 1 to reach the new target coordinate from the coordinate when the new target coordinate is received. To slow down.

なお、減速時に新たな目標座標を受け付けた場合に、減速させると、丁度、新たな目標座標に到達する場合がある。この場合は、目標座標と、新たな目標座標とが同じ座標であることを意味する。このため、上記の場合は、特に、想定しなくて良い。しかしながら、一実施形態に係るステッピングモータの制御方法によれば、目標座標と、新たな目標座標とが同じ座標であった場合にも、減速時に新たな目標座標を受け付けた場合に、減速させると、丁度、新たな目標座標に到達させることができる。この場合を、図5Cに示しておく。   In addition, when a new target coordinate is received at the time of deceleration, if it decelerates, it may just arrive at a new target coordinate. In this case, it means that the target coordinates and the new target coordinates are the same coordinates. For this reason, in the above case, it is not particularly necessary to assume. However, according to the control method of the stepping motor according to the embodiment, even when the target coordinates and the new target coordinates are the same coordinates, when the new target coordinates are received at the time of deceleration, the deceleration is performed. Just to reach the new target coordinates. This case is shown in FIG. 5C.

図5D及び図5Eは、減速させると、新たな目標座標を超える場合の制御例を示す。   FIG. 5D and FIG. 5E show examples of control when the new target coordinates are exceeded when decelerated.

コントローラ31は、新たな目標座標を受け付けた後、ステッピングモータ1の減速を続ける。ステッピングモータ1が停止した後、コントローラ31は、例えば、回転方向信号を反転させた後、駆動パルスを生成して、ステッピングモータ1を逆回転させ、ステッピングモータ1を新たな目標座標に到達するように加速及び減速(図5D)、又は最高速度Vpeakまで加速させた後に減速させる(図5E)。   The controller 31 continues to decelerate the stepping motor 1 after receiving the new target coordinates. After the stepping motor 1 stops, for example, the controller 31 inverts the rotation direction signal, generates a drive pulse, reversely rotates the stepping motor 1, and reaches the new target coordinates. Accelerate and decelerate (FIG. 5D), or accelerate to the maximum speed Vpeak and then decelerate (FIG. 5E).

これらの制御例1〜3が可能になるのは、主に、次の2つの理由からである。   These control examples 1 to 3 are possible mainly for the following two reasons.

(1) コントローラ31が、座標カウンタ33から、ステッピングモータ1が回転する前の座標と、ステッピングモータ1の回転中の絶対座標と、停止時を基準とした相対座標(回転開始から出力した駆動パルスの総数)とを把握しており、新たな目標座標を受け付けた際の座標から新たな目標座標まで回転させるのに必要なパルス数を取得できること、及び
(2) コントローラ31が、減速時座標変化量カウンタ34から、減速時座標変化量カウンタ34に蓄積された駆動パルス数を取得しており、ステッピングモータ1が、現在の速度から停止するまでに必要なパルス数を把握できていること、による。
(1) The controller 31 receives coordinates from the coordinate counter 33 before the stepping motor 1 rotates, absolute coordinates during rotation of the stepping motor 1, and relative coordinates based on the stop time (drive pulses output from the start of rotation). The number of pulses necessary to rotate from the coordinates when the new target coordinates are received to the new target coordinates, and (2) the controller 31 changes the coordinates during deceleration The number of drive pulses accumulated in the deceleration coordinate change amount counter 34 is acquired from the amount counter 34, and the stepping motor 1 is able to grasp the number of pulses necessary to stop from the current speed. .

このように、一実施形態によれば、上記(1)、(2)が可能となる構成を備えているので、ステッピングモータ1が回転中であっても、新たな目標座標を受け付けること、並びに回転中に受け付けた新たな目標座標に向かっての継続した回転動作が可能となる。   As described above, according to the embodiment, since the above configurations (1) and (2) are possible, even when the stepping motor 1 is rotating, a new target coordinate is received. A continuous rotation operation toward a new target coordinate accepted during rotation is possible.

従来は、図6A及び図6Bの参考例に示すように、ステッピングモータを目標座標までの回転を一旦終了させないと、新たな目標座標までの回転ができない。このため、目標座標を小刻みに変更する場合には、余分な加速及び減速時間が生じ、新たな目標座標に到達するまでに無駄な時間が生じていた。   Conventionally, as shown in the reference examples of FIGS. 6A and 6B, the stepping motor cannot be rotated to a new target coordinate unless the rotation to the target coordinate is once completed. For this reason, when the target coordinates are changed in small increments, extra acceleration and deceleration times are generated, and unnecessary time is generated until the new target coordinates are reached.

この点、一実施形態によれば、ステッピングモータ1が回転中であっても、新たな目標座標を受け付けること、並びに回転中に受け付けた新たな目標座標に向かっての継続した回転動作が可能であるので、目標座標を小刻みに変更する場合であっても、参考例に比較して、余分な加速及び減速時間がなく、新たな目標座標に短時間で到達させることができる。   In this regard, according to one embodiment, even when the stepping motor 1 is rotating, it is possible to receive a new target coordinate and to continuously rotate toward the new target coordinate received during the rotation. Therefore, even when the target coordinates are changed in small increments, compared to the reference example, there is no extra acceleration and deceleration time, and new target coordinates can be reached in a short time.

さらに、一実施形態においては、加速指示及び減速指示は、上位システム、本例ではCPU2からの指示で動作するパルスジェネレータ3に組み込まれたコントローラ31が行う。このため、上位システム、本例ではCPU2は、加速指示及び減速指示を発行せず、目標座標をコントローラ31に発行するだけで済む。このため、CPU2は、ステッピングモータ1が回転中であっても新たな目標座標の発行が可能となる。このように一実施形態においては、上位システムが、目標座標を発行するだけで済ませるようにすることも可能である。このため、上記一実施形態は、例えば、目標座標を小刻みに変更するような用途への利用に有用である。   Furthermore, in one embodiment, the acceleration instruction and the deceleration instruction are performed by the controller 31 incorporated in the pulse generator 3 that operates in accordance with an instruction from the host system, in this example, the CPU 2. For this reason, the host system, in this example, the CPU 2 does not issue the acceleration instruction and the deceleration instruction, but only issues the target coordinates to the controller 31. For this reason, the CPU 2 can issue new target coordinates even when the stepping motor 1 is rotating. Thus, in one embodiment, it is possible that the host system only needs to issue the target coordinates. For this reason, the said one embodiment is useful for the use for the use which changes a target coordinate to small increments, for example.

このように、この発明の一実施形態によれば、目標座標を小刻みに変更しても、ステッピングモータを目標座標まで短時間で回転させることが可能なステッピングモータの制御方法、ステッピングモータの制御装置及びステッピングモータシステムを提供することができる。   Thus, according to one embodiment of the present invention, a stepping motor control method and a stepping motor control device capable of rotating the stepping motor to the target coordinates in a short time even if the target coordinates are changed in small increments. And a stepping motor system can be provided.

以上、この発明を一実施形態にしたがって説明したが、この発明は上記一実施形態に限定されるものではなく、その主旨を逸脱しない範囲で様々に変形することができる。また、この発明の実施形態は、上記一実施形態が唯一の実施形態でもない。   As mentioned above, although this invention was demonstrated according to one Embodiment, this invention is not limited to the said one Embodiment, In the range which does not deviate from the main point, it can deform | transform variously. In the embodiment of the present invention, the above-described embodiment is not the only embodiment.

例えば、一実施形態においては、速度制御に、加速及び減速に台形制御を例示したが、加速及び減速は台形制御以外の制御、例えばS字制御の場合にも適用することができる。   For example, in the embodiment, the trapezoidal control is exemplified for the acceleration and deceleration in the speed control. However, the acceleration and deceleration can be applied to control other than the trapezoidal control, for example, S-shaped control.

また、システム構成は一例であり、一実施形態において説明したステッピングモータの制御方法が実行可能なシステム構成であれば、一実施形態において説明したシステム構成以外の構成とすることができる。
その他、この発明は、その趣旨を逸脱しない範囲で様々に変形することができる。
In addition, the system configuration is an example, and any system configuration other than the system configuration described in the embodiment can be used as long as the system configuration can execute the stepping motor control method described in the embodiment.
In addition, the present invention can be variously modified without departing from the gist thereof.

1…ステッピングモータ、2…CPU、3…パルスジェネレータ、4…ドライバ、31…コントローラ、32…速度カウンタ、33…座標カウンタ、34…減速時座標変化量カウンタ。   DESCRIPTION OF SYMBOLS 1 ... Stepping motor, 2 ... CPU, 3 ... Pulse generator, 4 ... Driver, 31 ... Controller, 32 ... Speed counter, 33 ... Coordinate counter, 34 ... Coordinate change amount counter at the time of deceleration

Claims (11)

ステッピングモータを、出力したパルスに従って目標座標まで回転させるステッピングモータの制御方法であって、
前記ステッピングモータの回転開始前の座標を取得し、
前記ステッピングモータを前記回転開始前の座標から前記目標座標まで回転させるために必要な第1のパルス数を取得し、
前記ステッピングモータの回転開始から出力した累計パルス数を取得して第2のパルス数とし、
前記第1のパルス数から前記第2のパルス数を減算することで、目標座標に到達させるために必要な第3のパルス数を取得し、
前記ステッピングモータが現在の速度から停止するまでに必要な第4のパルス数を取得し、
前記第3のパルス数及び前記第4のパルス数に基づいて、前記ステッピングモータを前記目標座標に向けて回転させるために、前記ステッピングモータを現在の速度から加速させるか、減速させるか、又は最高速度を維持させるかを判断することを特徴とするステッピングモータの制御方法。
A stepping motor control method for rotating a stepping motor to a target coordinate according to an output pulse,
Obtain the coordinates before starting the rotation of the stepping motor,
Obtaining a first number of pulses required to rotate the stepping motor from the coordinates before the start of rotation to the target coordinates;
The cumulative number of pulses output from the start of rotation of the stepping motor is obtained as the second number of pulses,
Subtracting the second pulse number from the first pulse number to obtain a third pulse number necessary to reach the target coordinates,
Obtaining a fourth number of pulses required until the stepping motor stops from the current speed;
Based on the third pulse number and the fourth pulse number, the stepping motor is accelerated from its current speed, decelerated, or maximum to rotate the stepping motor toward the target coordinates. A stepping motor control method comprising: determining whether to maintain a speed.
前記ステッピングモータが、現在座標から直ちに減速しても前記目標座標に到達しない場合、前記ステッピングモータを加速させる、又は最高速度を維持させ、
前記ステッピングモータが、現在座標から直ちに減速すると前記目標座標に到達する、又は超える場合、前記ステッピングモータを減速させることを特徴とする請求項1に記載のステッピングモータの制御方法。
If the stepping motor does not reach the target coordinates even if it is immediately decelerated from the current coordinates, the stepping motor is accelerated or the maximum speed is maintained,
2. The method of controlling a stepping motor according to claim 1, wherein when the stepping motor reaches or exceeds the target coordinate when it immediately decelerates from a current coordinate, the stepping motor is decelerated.
前記第4のパルス数が、前記ステッピングモータを加速させている間、出力したパルスを加算して蓄積し、前記蓄積されたパルス数から、前記ステッピングモータを減速させている間、出力したパルスを減算することで取得されることを特徴とする請求項1または2に記載のステッピングモータの制御方法。   While the stepping motor accelerates the stepping motor, the fourth pulse number adds and accumulates the output pulses, and from the accumulated pulse number, outputs the pulses output while decelerating the stepping motor. The stepping motor control method according to claim 1, wherein the stepping motor control method is obtained by subtraction. 前記ステッピングモータが回転しているときに新たな目標座標を受け付け、
前記新たな目標座標から前記回転開始前の座標を減算することで前記新たな目標座標に到達させるために必要な第5のパルス数を取得し、前記第5のパルス数で前記第1のパルス数を置き換えることを特徴とする請求項1から3のいずれか1項に記載のステッピングモータの制御方法。
Accept new target coordinates when the stepping motor is rotating,
A fifth pulse number required to reach the new target coordinate is obtained by subtracting the coordinates before the rotation start from the new target coordinate, and the first pulse is obtained with the fifth pulse number. The stepping motor control method according to claim 1, wherein the number is replaced.
速度ゼロから所定の速度に達するまでに必要なパルス数が、前記所定の速度から前記速度ゼロに達するまでに必要なパルス数と等しいことを特徴とする請求項3に記載のステッピングモータの制御方法。   4. The stepping motor control method according to claim 3, wherein the number of pulses required to reach a predetermined speed from zero speed is equal to the number of pulses required to reach the speed zero from the predetermined speed. . ステッピングモータを、出力したパルスに従って目標座標まで回転させるステッピングモータの制御装置であって、
前記ステッピングモータの回転開始前の座標を取得する手段と、
前記回転開始前の座標から前記目標座標まで到達させるために必要な第1のパルス数を取得する手段と、
回転開始後に出力した累計パルス数である第2のパルス数を取得する手段と、
前記第1のパルス数から前記第2のパルス数を減算することで、目標座標に到達させるために必要な第3のパルス数を取得する手段と、
現在の速度から停止するまでに必要な第4のパルス数を取得する手段と、
前記第3のパルス数及び前記第4のパルス数に基づいて、前記ステッピングモータを前記目標座標に向けて回転させるために、前記ステッピングモータを現在の速度から加速させるか、減速させるか、又は最高速度を維持させるかを判断する手段と、
を備えることを特徴とするステッピングモータの制御装置。
A stepping motor control device for rotating a stepping motor to a target coordinate according to an output pulse,
Means for obtaining coordinates before the rotation of the stepping motor is started;
Means for obtaining a first number of pulses necessary to reach the target coordinates from the coordinates before the rotation start;
Means for obtaining a second pulse number which is the cumulative pulse number output after the start of rotation;
Means for obtaining a third pulse number necessary to reach the target coordinates by subtracting the second pulse number from the first pulse number;
Means for obtaining a fourth number of pulses required to stop from the current speed;
Based on the third pulse number and the fourth pulse number, the stepping motor is accelerated from its current speed, decelerated, or maximum to rotate the stepping motor toward the target coordinates. A means of determining whether to maintain speed,
A stepping motor control device comprising:
前記ステッピングモータが、現在座標から直ちに減速しても前記目標座標に到達しない場合、前記ステッピングモータを加速させる、又は最高速度を維持させ、
前記ステッピングモータが、現在座標から直ちに減速すると前記目標座標に到達する、又は超える場合、前記ステッピングモータを減速させることを特徴とする請求項6に記載のステッピングモータの制御装置。
If the stepping motor does not reach the target coordinates even if it is immediately decelerated from the current coordinates, the stepping motor is accelerated or the maximum speed is maintained,
The stepping motor control device according to claim 6, wherein the stepping motor decelerates the stepping motor when reaching or exceeding the target coordinate when the stepping motor decelerates immediately from a current coordinate.
前記第4のパルス数が、前記ステッピングモータを加速させている間、出力したパルスを加算して蓄積し、前記蓄積されたパルス数から、前記ステッピングモータを減速させている間、出力したパルスを減算することで取得されることを特徴とする請求項6または7に記載のステッピングモータの制御装置。   While the stepping motor accelerates the stepping motor, the fourth pulse number adds and accumulates the output pulses, and from the accumulated pulse number, outputs the pulses output while decelerating the stepping motor. The stepping motor control device according to claim 6, wherein the stepping motor control device is obtained by subtraction. 前記ステッピングモータが回転しているときに新たな目標座標を受け付け、
前記新たな目標座標から前記回転開始前の座標を減算することで前記新たな目標座標に到達させるために必要な第5のパルス数を取得し、前記第5のパルス数で前記第1のパルス数を置き換えることを特徴とする請求項6から8のいずれか1項に記載のステッピングモータの制御装置。
Accept new target coordinates when the stepping motor is rotating,
A fifth pulse number required to reach the new target coordinate is obtained by subtracting the coordinates before the rotation start from the new target coordinate, and the first pulse is obtained with the fifth pulse number. 9. The stepping motor control apparatus according to claim 6, wherein the number is replaced.
速度ゼロから所定の速度に達するまでに必要なパルス数が、前記所定の速度から前記速度ゼロに達するまでに必要なパルス数と等しいことを特徴とする請求項8に記載のステッピングモータの制御装置。   The stepping motor control device according to claim 8, wherein the number of pulses required to reach a predetermined speed from zero speed is equal to the number of pulses required to reach the speed zero from the predetermined speed. . ステッピングモータと、
目標座標を発行するとともに、前記目標座標を発行した後に前記目標座標とは異なる新たな目標座標を発行することが可能な演算装置と、
前記目標座標、及び前記新たな目標座標を受け、前記ステッピングモータを回転させる駆動パルスを生成するパルスジェネレータと、
前記駆動パルスを受け、前記ステッピングモータを回転させるドライバと、を備え、
前記パルスジェネレータが、
前記目標座標、及び前記新たな目標座標を受け、加速指示及び減速指示を発行するコントローラと、
前記加速指示及び減速指示を受け、速度データを生成する速度カウンタと、
ステッピングモータの座標を記憶する領域と、回転開始から出力した累計パルス数を記憶する領域を含み、前記速度データを受けて前記ステッピングモータを回転させる駆動パルスを生成する座標カウンタと、
前記加速指示及び減速指示を受け、前記ステッピングモータを加速させている間、前記駆動パルスを、前記駆動パルスが生成されるごとに加算して蓄積し、前記蓄積された駆動パルス数から、前記ステッピングモータを減速させている間、前記駆動パルスを、前記駆動パルスが生成されるごとに減算する減速時座標変化量カウンタと、を含み、
前記コントローラが、
前記ステッピングモータの回転開始前の座標を前記座標カウンタから取得し、
前記ステッピングモータを前記回転開始前の座標から前記目標座標まで回転させるために必要な第1のパルス数を取得し、
前記ステッピングモータの回転開始から出力した累計パルス数を前記座標カウンタから取得して第2のパルス数とし、
前記第1のパルス数から前記第2のパルス数を減算することで、目標座標に到達させるために必要な第3のパルス数を取得し、
前記ステッピングモータが現在の速度から停止するまでに必要な第4のパルス数を前記減速時座標変化量カウンタから取得し、
前記第3のパルス数及び前記第4のパルス数に基づいて、前記ステッピングモータを前記目標座標に向けて回転させるために、前記ステッピングモータを現在の速度から加速させるか、減速させるか、又は最高速度を維持させるかを判断することを特徴とするステッピングモータシステム。
A stepping motor,
An arithmetic device capable of issuing a target coordinate and issuing a new target coordinate different from the target coordinate after issuing the target coordinate;
A pulse generator that receives the target coordinates and the new target coordinates and generates a driving pulse for rotating the stepping motor;
A driver for receiving the drive pulse and rotating the stepping motor;
The pulse generator is
A controller that receives the target coordinates and the new target coordinates and issues an acceleration instruction and a deceleration instruction;
A speed counter that receives the acceleration instruction and the deceleration instruction and generates speed data;
A coordinate counter including a region for storing the coordinates of the stepping motor and a region for storing the cumulative number of pulses output from the start of rotation, and generating a drive pulse for rotating the stepping motor in response to the speed data;
While receiving the acceleration instruction and the deceleration instruction and accelerating the stepping motor, the driving pulses are added and accumulated every time the driving pulses are generated, and the stepping is calculated from the accumulated number of driving pulses. A deceleration coordinate change amount counter that subtracts the drive pulse every time the drive pulse is generated while decelerating the motor,
The controller is
Obtain the coordinates before starting the rotation of the stepping motor from the coordinate counter,
Obtaining a first number of pulses required to rotate the stepping motor from the coordinates before the start of rotation to the target coordinates;
The cumulative number of pulses output from the start of rotation of the stepping motor is obtained from the coordinate counter as the second number of pulses,
Subtracting the second pulse number from the first pulse number to obtain a third pulse number necessary to reach the target coordinates,
The fourth pulse number required until the stepping motor stops from the current speed is acquired from the coordinate change counter during deceleration,
Based on the third pulse number and the fourth pulse number, the stepping motor is accelerated from its current speed, decelerated, or maximum to rotate the stepping motor toward the target coordinates. A stepping motor system for determining whether to maintain speed.
JP2009215581A 2009-09-17 2009-09-17 Motor control method for stepping motor, control device for the stepping motor, and stepping motor system Pending JP2011067013A (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2009215581A JP2011067013A (en) 2009-09-17 2009-09-17 Motor control method for stepping motor, control device for the stepping motor, and stepping motor system
PCT/JP2010/065031 WO2011033940A1 (en) 2009-09-17 2010-09-02 Motor control method, motor control device, and motor system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2009215581A JP2011067013A (en) 2009-09-17 2009-09-17 Motor control method for stepping motor, control device for the stepping motor, and stepping motor system

Publications (1)

Publication Number Publication Date
JP2011067013A true JP2011067013A (en) 2011-03-31

Family

ID=43758548

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2009215581A Pending JP2011067013A (en) 2009-09-17 2009-09-17 Motor control method for stepping motor, control device for the stepping motor, and stepping motor system

Country Status (2)

Country Link
JP (1) JP2011067013A (en)
WO (1) WO2011033940A1 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103346715B (en) * 2013-05-30 2015-10-28 奇瑞汽车股份有限公司 A kind of method of stepping motor Key dithering

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10117496A (en) * 1996-10-09 1998-05-06 Jonan Denki Kogyosho:Kk Automatic follow-up device
JP3661590B2 (en) * 2000-12-11 2005-06-15 トヨタ自動車株式会社 Step motor drive control device, step motor drive control method, step motor drive control program, and recording medium recording the program
JP2004295424A (en) * 2003-03-26 2004-10-21 Mitsubishi Electric Corp Positioning control method

Also Published As

Publication number Publication date
WO2011033940A1 (en) 2011-03-24

Similar Documents

Publication Publication Date Title
JP2007172080A (en) Fixed position stopping control device for rotating shaft
TWI632768B (en) Motor control device
JP2008254898A (en) Carrying device
JP2018040464A5 (en)
JP2018071593A (en) Shift range control device
JP6447141B2 (en) Robot emergency stop method, robot control device
JP2011067013A (en) Motor control method for stepping motor, control device for the stepping motor, and stepping motor system
JP6673195B2 (en) Shift range control device
JP2011130533A (en) Drive unit of stepping motor and drive method
JP5515644B2 (en) Position control device
JP6592389B2 (en) Crane driving support method and crane driving support device
JP5393374B2 (en) Overhead traveling crane
JP2015159660A (en) Servo motor controller
JP2009046238A (en) Elevator speed control device
JP2008011655A (en) Pulse motor controller
JP2016203310A (en) Fastening device
JP4158101B2 (en) Pulse generator IC for motor control
JP2006170946A (en) Rotary table controller
JP7296620B2 (en) Drive controller for stepping motor
JP2007127597A (en) Rotation angle detector
JP4290665B2 (en) Crane motion control device
JP2008131711A (en) Motor controller
JP2009194970A (en) Motor controller
JP2008027246A (en) Positioning controller and positioning control method
JP2579172B2 (en) Motor stop control method for sewing machine