JP6324619B2

JP6324619B2 - Step motor control apparatus and step motor control method

Info

Publication number: JP6324619B2
Application number: JP2017513950A
Authority: JP
Inventors: 今村　直樹; 直樹今村; 佳雄沖西; 寛康仲野
Original assignee: Mitsubishi Electric Corp
Current assignee: Mitsubishi Electric Corp
Priority date: 2015-04-21
Filing date: 2015-12-21
Publication date: 2018-05-16
Anticipated expiration: 2035-12-21
Also published as: JPWO2016170712A1; WO2016170712A1

Description

この発明は、ステップモータにより駆動される駆動機構に対して適用されるステップモータ制御装置およびステップモータ制御方法に関するものである。 The present invention relates to a step motor control device and a step motor control method applied to a drive mechanism driven by a step motor.

従来から、加速駆動時に様々な要因により負荷が増大した場合であっても、ステップモータを脱調させることなく、正しく目標位置に到達させることができるステップモータの駆動制御方法が知られている（例えば、特許文献１参照）。 2. Description of the Related Art Conventionally, there is known a step motor drive control method that can correctly reach a target position without causing the step motor to step out even when the load increases due to various factors during acceleration driving ( For example, see Patent Document 1).

具体的には、ステップモータを、制御回路と駆動回路とで加速テーブルに従って加速駆動する工程において、加速テーブルによる指令回転位置に対するステップモータの回転位置の遅れ量を、回転角センサと遅れ量検出回路とで検出する。 Specifically, in the step of accelerating and driving the step motor by the control circuit and the drive circuit according to the acceleration table, the rotation angle sensor and the delay amount detection circuit indicate the delay amount of the rotation position of the step motor relative to the command rotation position by the acceleration table. And detect.

続いて、検出した遅れ量を、比較回路であらかじめ設定した値と比較し、遅れ量が設定値に達した場合には、ステップモータを等速駆動に切り換え、等速駆動によって加速テーブルで定められたステップ量を完了させている。 Subsequently, the detected delay amount is compared with a value set in advance by the comparison circuit, and when the delay amount reaches the set value, the stepping motor is switched to constant speed driving and is determined by the acceleration table by constant speed driving. The completed step amount is completed.

特許文献１によれば、回転角センサと遅れ量検出回路とで検出されたステップモータの回転位置の遅れ量が設定値に達した場合に、等速駆動に切り換えることにより、ステップモータに与える１つ１つの駆動パルスの時間を長く保って、ステップモータの出力トルクを保持し、負荷増大による脱調を防止することができるとされている。 According to Patent Document 1, when the delay amount of the rotational position of the step motor detected by the rotation angle sensor and the delay amount detection circuit reaches a set value, it is given to the step motor by switching to constant speed driving. It is said that the time of each drive pulse can be kept long, the output torque of the step motor can be maintained, and step-out due to an increase in load can be prevented.

また、負荷の環境温度を検出するための温度センサを利用して、ステップモータの駆動停止時に検出した温度センサの出力が所定温度に達した場合に、ステップモータの駆動電流を所定電流となるように制御するステップモータの駆動制御方法が知られている（例えば、特許文献２参照）。 Further, by using a temperature sensor for detecting the environmental temperature of the load, when the output of the temperature sensor detected when the step motor is stopped reaches a predetermined temperature, the drive current of the step motor becomes a predetermined current. A step motor drive control method is known (for example, see Patent Document 2).

特許文献２によれば、環境温度の変化に応じてステップモータの駆動電流を可変することにより、ステップモータの出力トルクが適正となるので、駆動効率が高くなるとともに、放熱板や冷却ファン等のハードウェア的な温度対策を不要にすることができるとされている。 According to Patent Document 2, since the output torque of the step motor becomes appropriate by varying the drive current of the step motor in accordance with the change of the environmental temperature, the drive efficiency is increased and the heat sink, cooling fan, etc. It is said that hardware temperature measures can be eliminated.

特開平５−１５１９７号公報Japanese Patent Laid-Open No. 5-15197 特開平２−４６１９５号公報JP-A-2-46195

しかしながら、従来技術には、以下のような課題がある。
すなわち、特許文献１のステップモータの駆動制御方法では、ステップモータの回転位置を検出するための付加的なセンサを要するとともに、当該センサの検出値をもとに速度テーブルを読み出す必要があるので、ハードウェアおよびソフトウェアの構成が複雑になるという問題がある。However, the prior art has the following problems.
That is, in the step motor drive control method of Patent Document 1, an additional sensor for detecting the rotational position of the step motor is required, and the speed table needs to be read based on the detection value of the sensor. There is a problem that the configuration of hardware and software is complicated.

また、特に速度指令は、検出値の閾値に基づいて、加減速区間と等速区間とがあらかじめ設定されたテーブルで一意に固定されているので、駆動途中に負荷が変動した場合に、ステップモータのトルクマージンを許容する範囲で速度指令を任意に変更することができず、脱調するという問題がある。 In particular, the speed command is based on the threshold value of the detected value, and the acceleration / deceleration section and the constant speed section are uniquely fixed in a preset table. Therefore, when the load fluctuates during driving, the step motor There is a problem that the speed command cannot be arbitrarily changed within a range in which the torque margin is allowed and step out occurs.

また、特許文献２のステップモータの駆動制御方法では、負荷検出のための温度センサが駆動停止時のみ利用されるので、特許文献１と同様に、駆動途中に負荷が変動した場合に、ステップモータのトルクマージンを許容する範囲で速度指令を任意に変更することができず、脱調するという問題がある。 Further, in the step motor drive control method of Patent Document 2, since the temperature sensor for load detection is used only when the drive is stopped, as in Patent Document 1, when the load fluctuates during driving, the step motor There is a problem that the speed command cannot be arbitrarily changed within a range in which the torque margin is allowed and step out occurs.

この発明は、上記のような課題を解決するためになされたものであり、簡素な構成で脱調を防止することができるステップモータ制御装置およびステップモータ制御方法を得ることを目的とする。 The present invention has been made to solve the above-described problems, and an object of the present invention is to provide a step motor control device and a step motor control method that can prevent step-out with a simple configuration.

この発明に係るステップモータ制御装置は、角度指令に基づいてステップモータの角度制御を行うステップモータ制御装置であって、ステップモータに対する角度指令を出力する角度指令演算部と、角度指令演算部の出力である角度指令および温度検出部で検出された周囲温度に基づいて、本角速度指令を演算する速度指令演算部と、速度指令演算部の出力である本角速度指令に基づいて、ステップモータに対する速度指令パルスを生成するとともに、速度指令パルスを加算して推定角度を演算して推定角度を速度指令演算部にフィードバックする駆動演算部と、を備え、速度指令演算部は、推定角度に基づいて本角速度指令を演算して本角速度指令を出力するものである。 A step motor control device according to the present invention is a step motor control device that performs angle control of a step motor based on an angle command, an angle command calculation unit that outputs an angle command to the step motor, and an output of the angle command calculation unit Based on the angle command and the ambient temperature detected by the temperature detection unit, the speed command calculation unit that calculates the actual angular velocity command, and the speed command for the step motor based on the actual angular velocity command that is the output of the speed command calculation unit A drive calculation unit that generates a pulse and calculates an estimated angle by adding a speed command pulse and feeds back the estimated angle to the speed command calculation unit, and the speed command calculation unit is configured to calculate the actual angular velocity based on the estimated angle. The command is calculated and the angular velocity command is output.

また、この発明に係るステップモータ制御方法は、角度指令に基づいてステップモータの角度制御を行うステップモータ制御装置で実現されるステップモータ制御方法であって、ステップモータに対する角度指令を出力するステップと、角度指令および周囲温度に基づいて、本角速度指令を演算するステップと、本角速度指令に基づいて、ステップモータに対する速度指令パルスを生成するステップと、速度指令パルスを加算して推定角度を演算するステップと、推定角度を、本角速度指令を演算するステップにフィードバックさせるステップと、を有するものである。 Further, a step motor control method according to the present invention is a step motor control method realized by a step motor control device that performs angle control of a step motor based on an angle command, the step of outputting an angle command for the step motor; The step of calculating the main angular velocity command based on the angle command and the ambient temperature, the step of generating a speed command pulse for the step motor based on the main angular velocity command, and calculating the estimated angle by adding the speed command pulse And a step of feeding back the estimated angle to the step of calculating the actual angular velocity command.

この発明に係るステップモータ制御装置およびステップモータ制御方法によれば、速度指令演算部は、角度指令演算部の出力である角度指令および温度検出部で検出された周囲温度に基づいて、本角速度指令を演算し、駆動演算部は、速度指令演算部の出力である本角速度指令に基づいて、ステップモータに対する速度指令パルスを生成するとともに、速度指令パルスを加算して演算された推定角度を速度指令演算部にフィードバックさせる。
そのため、簡素な構成で脱調を防止することができるステップモータ制御装置およびステップモータ制御方法を得ることができる。According to the step motor control device and the step motor control method according to the present invention, the speed command calculation unit is configured to detect the angular speed command based on the angle command output from the angle command calculation unit and the ambient temperature detected by the temperature detection unit. The drive calculation unit generates a speed command pulse for the step motor based on the main angular velocity command output from the speed command calculation unit, and adds the speed command pulse to the estimated angle calculated by the speed command. Feedback to the calculation unit.
Therefore, it is possible to obtain a step motor control device and a step motor control method that can prevent step-out with a simple configuration.

（ａ）〜（ｄ）は、この発明の実施の形態１に係るステップモータの角速度とトルク特性との関係を示す説明図である。(A)-(d) is explanatory drawing which shows the relationship between the angular velocity and torque characteristic of the step motor which concern on Embodiment 1 of this invention. この発明の実施の形態１に係るステップモータ制御装置を、モータ駆動回路、ステップモータ、駆動機構および温度検出部とともに示すブロック構成図である。It is a block block diagram which shows the step motor control apparatus which concerns on Embodiment 1 of this invention with a motor drive circuit, a step motor, a drive mechanism, and a temperature detection part. この発明の実施の形態１に係る速度指令演算部を詳細に示すブロック構成図である。It is a block block diagram which shows the speed command calculating part which concerns on Embodiment 1 of this invention in detail. この発明の実施の形態１に係る駆動演算部の処理を示すフローチャートである。It is a flowchart which shows the process of the drive calculating part which concerns on Embodiment 1 of this invention. この発明の実施の形態２に係るステップモータ制御装置を、モータ駆動回路、ステップモータ、駆動機構および温度検出部とともに示すブロック構成図である。It is a block block diagram which shows the step motor control apparatus which concerns on Embodiment 2 of this invention with a motor drive circuit, a step motor, a drive mechanism, and a temperature detection part. この発明の実施の形態２に係る駆動演算部の全体処理を示すフローチャートである。It is a flowchart which shows the whole process of the drive calculating part which concerns on Embodiment 2 of this invention. この発明の実施の形態２に係る駆動演算部の励磁切換・電流振幅指令演算処理およびパルス周期演算処理を示すフローチャートである。It is a flowchart which shows the excitation switching and the current amplitude command calculation process of the drive calculating part which concerns on Embodiment 2 of this invention, and a pulse period calculation process. この発明の実施の形態２に係るステップモータのフルステップ駆動時およびマイクロステップ駆動時の電流ベクトルを示す説明図である。It is explanatory drawing which shows the electric current vector at the time of the full step drive of the step motor which concerns on Embodiment 2 of this invention, and a micro step drive. この発明の実施の形態３に係るステップモータ制御装置を、モータ駆動回路、ステップモータ、駆動機構、温度検出部および外部インターフェースとともに示すブロック構成図である。It is a block block diagram which shows the step motor control apparatus which concerns on Embodiment 3 of this invention with a motor drive circuit, a step motor, a drive mechanism, a temperature detection part, and an external interface. この発明の実施の形態４に係るステップモータ制御装置を、モータ駆動回路、ステップモータ、駆動機構、温度検出部および外部インターフェースとともに示すブロック構成図である。It is a block block diagram which shows the step motor control apparatus which concerns on Embodiment 4 of this invention with a motor drive circuit, a step motor, a drive mechanism, a temperature detection part, and an external interface.

以下、この発明に係るステップモータ制御装置およびステップモータ制御方法の好適な実施の形態につき図面を用いて説明するが、各図において同一、または相当する部分については、同一符号を付して説明する。 Hereinafter, preferred embodiments of a step motor control device and a step motor control method according to the present invention will be described with reference to the drawings. In the drawings, the same or corresponding parts will be described with the same reference numerals. .

なお、この発明に係るステップモータ制御装置およびステップモータ制御方法によれば、負荷検出目的に負荷の周囲温度を検出する温度検出部を利用して、回転負荷の変動に対するステップモータの脱調をなくす本角速度指令を生成し、さらに本角速度指令には、フルステップ駆動とステップモータ特有のマイクロステップ駆動とを併用することで、振動の小さい滑らかな始動および停止、並びに駆動機構の所定角度への高精度な位置決めを実現することができる。 According to the step motor control device and the step motor control method of the present invention, the step detection of the step motor with respect to the fluctuation of the rotational load is eliminated by using the temperature detection unit that detects the ambient temperature of the load for the purpose of load detection. A main angular velocity command is generated, and the full angular velocity command is used in combination with a full step drive and a micro step drive unique to a step motor, so that smooth start and stop with small vibrations and a high angle to a predetermined angle of the drive mechanism can be achieved. Accurate positioning can be realized.

実施の形態１．
まず、図１を参照しながら、この発明の実施の形態１に係るステップモータの角速度とトルク特性との関係について説明する。図１（ａ）は設計時の状態を示し、図１（ｂ）は温度低下時の状態を示し、図１（ｃ）は加速トルク低減時の状態を示し、図１（ｄ）は最大角速度低減時の状態を示している。Embodiment 1 FIG.
First, the relationship between the angular velocity and torque characteristics of the step motor according to Embodiment 1 of the present invention will be described with reference to FIG. 1A shows the state at the time of design, FIG. 1B shows the state when the temperature is lowered, FIG. 1C shows the state when the acceleration torque is reduced, and FIG. 1D shows the maximum angular velocity. The state at the time of reduction is shown.

駆動機構をステップモータで駆動する際には、加速トルクと負荷トルクとの和がモータ固有のトルク特性以下となるように設計される。具体的には、図１（ａ）に示すように、モータ固有のトルク特性に対して所定のトルクマージン（＝モータ固有のトルク特性／設計トルク）を設けた設計トルクに対して、加速トルクと負荷トルクとの和が設計トルク以下となるように設計する。 When the drive mechanism is driven by the step motor, the sum of the acceleration torque and the load torque is designed to be less than the torque characteristic specific to the motor. Specifically, as shown in FIG. 1 (a), acceleration torque with respect to design torque provided with a predetermined torque margin (= motor-specific torque characteristic / design torque) with respect to motor-specific torque characteristics. Design so that the sum with the load torque is less than the design torque.

ところが、駆動機構の摩擦に代表される負荷トルクは、温度変化に対してばらつきが大きい上に、特に低温では、駆動機構に具備された、例えば軸受のグリスの粘性が高くなる。そのため、図１（ｂ）に示すように、負荷トルクが増大した結果、加速トルクと負荷トルクとの和が設計トルクを上回り、トルクマージンが低下する。 However, the load torque represented by the friction of the drive mechanism has a large variation with respect to the temperature change, and the viscosity of, for example, the grease of the bearing provided in the drive mechanism becomes high particularly at low temperatures. Therefore, as shown in FIG. 1B, as the load torque increases, the sum of the acceleration torque and the load torque exceeds the design torque, and the torque margin decreases.

一方、主にモータメーカーより提供されるモータ固有のトルク特性は、常温で計測されたものが一般的であることから、温度変化に応じてモータ固有のトルク特性も当然のことながら変化する。また、モータ毎の個体ばらつきもある。 On the other hand, since the motor-specific torque characteristics mainly provided by motor manufacturers are generally measured at normal temperature, the motor-specific torque characteristics naturally change according to temperature changes. There is also individual variation for each motor.

したがって、このようなモータ固有のトルク特性のばらつきを吸収できることも踏まえた設計指針で設定された設計トルクに対して、加速トルクと負荷トルクとの和がこれを上回ると、ステップモータは脱調する。 Therefore, if the sum of the acceleration torque and the load torque exceeds the design torque set by the design guideline based on the fact that it is possible to absorb such variations in torque characteristics unique to the motor, the stepping motor will step out. .

そこで、この発明の実施の形態１では、加速トルクと負荷トルクとの和を、設計トルク以下に収めることができるステップモータ制御装置を提供する。 Therefore, Embodiment 1 of the present invention provides a step motor control device that can keep the sum of acceleration torque and load torque below the design torque.

このステップモータ制御装置は、図１（ｃ）に示すように、最大角速度を図１（ｂ）と同一にしたまま、温度低下時に増大する負荷トルクを、加速トルクの低減で吸収する機能を有している。また、このステップモータ制御装置は、図１（ｄ）に示すように、加速トルクと負荷トルクとの和を図１（ｂ）と同一にしたまま、温度低下時に増大する負荷トルクを考慮して、最大角速度を低減する機能を有している。 As shown in FIG. 1C, this step motor control device has a function of absorbing the load torque that increases when the temperature decreases while reducing the acceleration torque while keeping the maximum angular velocity the same as in FIG. 1B. doing. In addition, as shown in FIG. 1 (d), this step motor control device takes into account the load torque that increases when the temperature drops while keeping the sum of acceleration torque and load torque the same as in FIG. 1 (b). It has a function to reduce the maximum angular velocity.

図２は、この発明の実施の形態１に係るステップモータ制御装置を、モータ駆動回路、ステップモータ、駆動機構および温度検出部とともに示すブロック構成図である。図２において、ステップモータ制御装置１Ａは、角度指令演算部１０、速度指令演算部２０および駆動演算部３０Ａを備えている。 FIG. 2 is a block configuration diagram showing the step motor control device according to the first embodiment of the present invention together with a motor drive circuit, a step motor, a drive mechanism, and a temperature detection unit. In FIG. 2, the step motor control apparatus 1A includes an angle command calculation unit 10, a speed command calculation unit 20, and a drive calculation unit 30A.

また、角度指令演算部１０、速度指令演算部２０および駆動演算部３０Ａは、例えばそれぞれ図示しないＣＰＵ（ＣｅｎｔｒａｌＰｒｏｃｅｓｓｉｎｇＵｎｉｔ）とプログラムを格納した記憶部とを有するマイクロプロセッサで構成されている。 In addition, the angle command calculation unit 10, the speed command calculation unit 20, and the drive calculation unit 30A are each configured by a microprocessor having a CPU (Central Processing Unit) (not shown) and a storage unit storing a program, for example.

また、ステップモータ制御装置１Ａは、モータ駆動回路２００に接続され、モータ駆動回路２００は、ステップモータ３００に接続され、ステップモータ３００は、駆動機構４００に接続されている。また、ステップモータ制御装置１Ａは、温度検出部５００にも接続されている。 Further, the step motor control device 1A is connected to the motor drive circuit 200, the motor drive circuit 200 is connected to the step motor 300, and the step motor 300 is connected to the drive mechanism 400. The step motor control device 1A is also connected to the temperature detection unit 500.

角度指令演算部１０は、駆動機構４００を任意の所定の角度に位置決めするために駆動するステップモータ３００の角度指令を出力する。 The angle command calculation unit 10 outputs an angle command of the step motor 300 that is driven to position the drive mechanism 400 at an arbitrary predetermined angle.

速度指令演算部２０は、角度指令演算部１０の出力である角度指令、駆動演算部３０Ａの出力である推定角度、および温度検出部５００の出力である負荷の周囲温度に基づいて、本角速度指令を演算する。 The speed command calculation unit 20 is configured to determine the actual angular speed command based on the angle command that is the output of the angle command calculation unit 10, the estimated angle that is the output of the drive calculation unit 30A, and the ambient temperature of the load that is the output of the temperature detection unit 500. Is calculated.

駆動演算部３０Ａは、速度指令演算部２０の出力である本角速度指令に基づいて、ステップモータ３００の速度指令パルス、回転方向指令、励磁切換指令および電流振幅指令をモータ駆動回路２００に出力する。さらに、駆動演算部３０Ａは、推定角度を速度指令演算部２０に出力する。 The drive calculation unit 30A outputs a speed command pulse, a rotation direction command, an excitation switching command, and a current amplitude command of the step motor 300 to the motor drive circuit 200 based on the main angular velocity command that is the output of the speed command calculation unit 20. Further, the drive calculation unit 30 </ b> A outputs the estimated angle to the speed command calculation unit 20.

モータ駆動回路２００は、ステップモータ３００に電力供給して駆動するための汎用のドライバＩＣが実装された電気回路であって、モータ駆動回路２００の出力であるモータ電流をステップモータ３００の各相の巻線に流すことでステップモータ３００を駆動し、ステップモータ３００の回転軸に取り付けられた駆動機構４００を、所定角度に位置決め制御する。 The motor drive circuit 200 is an electric circuit on which a general-purpose driver IC for supplying power to the step motor 300 for driving is mounted, and the motor current output from the motor drive circuit 200 is output for each phase of the step motor 300. The step motor 300 is driven by flowing it through the winding, and the drive mechanism 400 attached to the rotating shaft of the step motor 300 is positioned and controlled at a predetermined angle.

ここで、駆動機構４００は、図示しないが、ステップモータ３００のトルクを伝達する歯車やベルト等の減速機を含むものである。また、温度検出部５００は、サーミスタ等の素子であって、負荷の周囲温度を検出してステップモータ制御装置１Ａに出力する。 Here, although not shown, the drive mechanism 400 includes a speed reducer such as a gear or a belt that transmits the torque of the step motor 300. The temperature detection unit 500 is an element such as a thermistor and detects the ambient temperature of the load and outputs the detected temperature to the step motor control device 1A.

続いて、ステップモータ制御装置１Ａの動作について説明する。まず、図３を参照しながら、速度指令演算部２０の構成および機能について説明する。図３は、この発明の実施の形態１に係る速度指令演算部を詳細に示すブロック構成図である。 Then, operation | movement of 1 A of step motor control apparatuses is demonstrated. First, the configuration and function of the speed command calculation unit 20 will be described with reference to FIG. FIG. 3 is a block diagram showing in detail the speed command calculation unit according to the first embodiment of the present invention.

図３において、速度指令演算部２０は、第１制御器２１、飽和器２２および第２制御器２３を有し、角度指令演算部１０の出力である角度指令θｃｏｍ、駆動演算部３０Ａの出力である推定角度θｅｓｔ、および温度検出部５００の出力である負荷の周囲温度Ｔに基づいて、ステップモータ３００の本角速度指令ωｃｏｍを出力する。角度指令θｃｏｍは、例えばあらかじめ時間の関数として与えられる任意の指令であってもよいし、時間と角度とのテーブルとして与えられる任意の指令であってもよい。 In FIG. 3, the speed command calculation unit 20 includes a first controller 21, a saturator 22, and a second controller 23, and an angle command θcom that is an output of the angle command calculation unit 10 and an output of the drive calculation unit 30 </ b> A. Based on a certain estimated angle θest and the ambient temperature T of the load, which is the output of the temperature detector 500, the main angular velocity command ωcom of the step motor 300 is output. The angle command θcom may be an arbitrary command given in advance as a function of time, for example, or an arbitrary command given as a table of time and angle.

第１制御器２１は、角度指令θｃｏｍと推定角度θｅｓｔとの角度偏差θｃｏｍ−θｅｓｔと、負荷の周囲温度Ｔとに基づいて、次式（１）により、中間角速度指令ωｃｏｍ＿ｐｒｅを演算する。式（１）において、比例ゲインＫｐ（Ｔ）は、Ｋｐが温度Ｔの関数であることを意味している。 The first controller 21 calculates the intermediate angular velocity command ωcom_pre by the following equation (1) based on the angle deviation θcom−θest between the angle command θcom and the estimated angle θest and the ambient temperature T of the load. In equation (1), the proportional gain Kp (T) means that Kp is a function of the temperature T.

このようにすることで、角度指令演算部１０から出力された角度指令θｃｏｍがステップ状、ランプ状等のいかなる角度指令に対しても、角度指令θｃｏｍに対する推定角度θｅｓｔの角度フィードバックおよび第１制御器２１の作用により、中間角速度指令ωｃｏｍ＿ｐｒｅの傾き、すなわち角速度の変化率を調整することができる。 By doing in this way, the angle feedback of the estimated angle θest with respect to the angle command θcom and the first controller, regardless of the angle command θcom output from the angle command calculation unit 10 is any step command, ramp shape, or the like. By the action of 21, the inclination of the intermediate angular velocity command ωcom_pre, that is, the rate of change of the angular velocity can be adjusted.

このとき、比例ゲインＫｐ（Ｔ）は、負荷の周囲温度Ｔに応じて自動的に調整されるが、例えば、比例ゲインＫｐ（Ｔ）を、負荷の周囲温度Ｔの単調増加関数とする。一般に、低温で増加する駆動機構４００の負荷トルクに対しては、加速トルクを小さくするように比例ゲインＫｐ（Ｔ）を小さく設定し、中間角速度指令ωｃｏｍ＿ｐｒｅの変化率を小さくする。このようにすることで、加速時間が長くなり、加速トルクを小さくすることができる。 At this time, the proportional gain Kp (T) is automatically adjusted according to the ambient temperature T of the load. For example, the proportional gain Kp (T) is a monotonically increasing function of the ambient temperature T of the load. Generally, with respect to the load torque of the drive mechanism 400 that increases at a low temperature, the proportional gain Kp (T) is set small so as to reduce the acceleration torque, and the change rate of the intermediate angular velocity command ωcom_pre is reduced. By doing in this way, acceleration time becomes long and acceleration torque can be made small.

飽和器２２は、第１制御器２１の出力である中間角速度指令ωｃｏｍ＿ｐｒｅと第２制御器２３の出力である本角速度指令ωｃｏｍとの角速度偏差と、負荷の周囲温度Ｔとに基づいて、次式（２）により、角加速度の上下限制限値ωｄｏｔ＿ｓａｔを演算する。 Based on the angular velocity deviation between the intermediate angular velocity command ωcom_pre that is the output of the first controller 21 and the main angular velocity command ωcom that is the output of the second controller 23, and the ambient temperature T of the load, the saturator 22 From (2), the upper and lower limit value ωdot_sat of the angular acceleration is calculated.

式（２）において、ωｄｏｔ＿ｍａｘおよびωｄｏｔ＿ｍｉｎは、温度Ｔの関数として設定される。また、式（２）の出力は、角速度の差分なので、角加速度指令と等価であることに留意する。 In equation (2), ωdot_max and ωdot_min are set as a function of the temperature T. Note that the output of equation (2) is equivalent to the angular acceleration command because it is the difference in angular velocity.

第２制御器２３は、飽和器２２の出力である角加速度の上下限制限値ωｄｏｔ＿ｓａｔに基づいて、次式（３）により、本角速度指令ωｃｏｍを演算する。式（３）において、Ｋｉは積分ゲインを表し、ｓはラプラス演算子を表している。 The second controller 23 calculates the angular velocity command ωcom according to the following equation (3) based on the upper and lower limit value ωdot_sat of the angular acceleration that is the output of the saturator 22. In Expression (3), Ki represents an integral gain, and s represents a Laplace operator.

このようにすることで、飽和器２２による角加速度指令の制限を、負荷の周囲温度Ｔに応じて可変とし、低温においては、最大角速度の設定をモータ固有のトルク特性が大きい範囲内での駆動に制限することができる。 In this way, the limit of the angular acceleration command by the saturator 22 is made variable according to the ambient temperature T of the load, and at a low temperature, the maximum angular velocity is set within a range where the motor-specific torque characteristics are large. Can be limited to.

次に、図４を参照しながら、駆動演算部３０Ａの処理について説明する。図４は、この発明の実施の形態１に係る駆動演算部の処理を示すフローチャートである。駆動演算部３０Ａは、本角速度指令ωｃｏｍに基づいて、速度指令パルス、回転方向指令、励磁切換指令、電流振幅指令および速度指令パルスをカウントすることで得られる速度指令パルスカウント値、すなわち推定角度を出力する。 Next, the processing of the drive calculation unit 30A will be described with reference to FIG. FIG. 4 is a flowchart showing processing of the drive calculation unit according to Embodiment 1 of the present invention. The drive calculation unit 30A calculates a speed command pulse count value obtained by counting a speed command pulse, a rotation direction command, an excitation switching command, a current amplitude command, and a speed command pulse, that is, an estimated angle, based on the main angular speed command ωcom. Output.

まず、本角速度指令ωｃｏｍの正負を判定する（ステップＳ１）。
ステップＳ１において、本角速度指令ωｃｏｍが０であると判定された場合には、速度指令パルスを停止して（ステップＳ２）、後述するステップＳ６に移行する。First, the sign of the main angular velocity command ωcom is determined (step S1).
In step S1, when it is determined that the actual angular velocity command ωcom is 0, the velocity command pulse is stopped (step S2), and the process proceeds to step S6 described later.

一方、ステップＳ１において、本角速度指令ωｃｏｍが正であると判定された場合には、回転方向指令を正転（Ｄｉｒ＝１）に設定する（ステップＳ３）。
また、ステップＳ１において、本角速度指令ωｃｏｍが負であると判定された場合には、回転方向指令を反転（Ｄｉｒ＝０）に設定する（ステップＳ４）。On the other hand, when it is determined in step S1 that the main angular velocity command ωcom is positive, the rotation direction command is set to normal rotation (Dir = 1) (step S3).
If it is determined in step S1 that the main angular velocity command ωcom is negative, the rotation direction command is set to reverse (Dir = 0) (step S4).

続いて、次式（４）により、速度指令パルスのパルス周期ｔｐを演算する（ステップＳ５）。 Subsequently, the pulse period tp of the speed command pulse is calculated by the following equation (4) (step S5).

次に、ステップＳ５で演算されたパルス周期ｔｐに基づいて、速度指令パルスを生成する（ステップＳ６）。
続いて、ステップＳ６で生成された速度指令パルスを、パルスのアップエッジまたはダウンエッジの何れかでカウントする（ステップＳ７）。Next, a speed command pulse is generated based on the pulse period tp calculated in step S5 (step S6).
Subsequently, the speed command pulse generated in step S6 is counted at either the up edge or the down edge of the pulse (step S7).

このとき、角度指令の最終値までカウントした時点で、カウント値を０にリセットする。なお、この速度指令パルスの１パルス分は、ステップモータ３００のステップ角θｓに相当することから、速度指令パルスカウント値は、ステップモータ３００の推定角度θｅｓｔである。また、推定角度としているのは、ステップＳ７で演算されるカウント値は、ステップモータ３００の回転角度を直接検知した値ではないことによる。 At this time, the count value is reset to 0 when the angle command is counted to the final value. Since one pulse of the speed command pulse corresponds to the step angle θs of the step motor 300, the speed command pulse count value is the estimated angle θest of the step motor 300. Further, the reason for the estimated angle is that the count value calculated in step S7 is not a value obtained by directly detecting the rotation angle of the step motor 300.

一方、電流振幅指令生成処理では、本角速度指令ωｃｏｍによらず一定の電流振幅を与える電流振幅指令を生成する（ステップＳ８）。
また、励磁切換指令生成処理では、本角速度指令ωｃｏｍによらずフルステップ駆動の励磁切換指令を生成する（ステップＳ９）。On the other hand, in the current amplitude command generation process, a current amplitude command that gives a constant current amplitude is generated regardless of the main angular velocity command ωcom (step S8).
In the excitation switching command generation process, an excitation switching command for full step drive is generated regardless of the actual angular velocity command ωcom (step S9).

ここで、ステップＳ７で得られた推定角度θｅｓｔを速度指令演算部２０にフィードバックすることにより、ステップモータ３００を角度指令ベースで制御することができる。 Here, by feeding back the estimated angle θest obtained in step S7 to the speed command calculation unit 20, the step motor 300 can be controlled on an angle command basis.

以上のように、実施の形態１によれば、駆動演算部３０Ａで生成された速度指令パルスを、パルスのアップエッジまたはダウンエッジの何れかでカウントしたステップモータ３００の推定角度θｅｓｔを速度指令演算部２０への角度フィードバックへ利用し、速度指令演算部２０では、温度検出部５００にて得られた負荷の周囲温度Ｔに基づいて、ステップモータ３００の設計トルク以下となるように角速度変化率および角加速度の制限を自動調整した本角速度指令を生成できるので、トルクマージンを低下させることなく、ステップモータを脱調させない駆動を実現することができる。 As described above, according to the first embodiment, the speed command calculation is performed on the estimated angle θest of the step motor 300 obtained by counting the speed command pulse generated by the drive calculation unit 30A at either the up edge or the down edge of the pulse. The velocity command calculation unit 20 uses the angular velocity change rate and the torque so as to be equal to or lower than the design torque of the step motor 300 based on the ambient temperature T of the load obtained by the temperature detection unit 500. Since the main angular velocity command in which the limit of angular acceleration is automatically adjusted can be generated, it is possible to realize driving without stepping out the step motor without reducing the torque margin.

すなわち、実施の形態１によれば、速度指令演算部は、角度指令演算部の出力である角度指令、フィードバックされた推定角度、および温度検出部で検出された周囲温度に基づいて、本角速度指令を演算し、駆動演算部は、速度指令演算部の出力である本角速度指令に基づいて、ステップモータに対する速度指令パルスを生成するとともに、速度指令パルスを加算して演算された推定角度を速度指令演算部および駆動演算部のうち、少なくとも速度指令演算部にフィードバックさせる。
そのため、簡素な構成で脱調を防止することができるステップモータ制御装置およびステップモータ制御方法を得ることができる。In other words, according to the first embodiment, the speed command calculation unit is configured to perform the actual angular speed command based on the angle command output from the angle command calculation unit, the estimated angle fed back, and the ambient temperature detected by the temperature detection unit. The drive calculation unit generates a speed command pulse for the step motor based on the main angular velocity command output from the speed command calculation unit, and adds the speed command pulse to the estimated angle calculated by the speed command. Of the calculation unit and the drive calculation unit, at least the speed command calculation unit is fed back.
Therefore, it is possible to obtain a step motor control device and a step motor control method that can prevent step-out with a simple configuration.

また、ステップモータの推定角度をフィードバック制御に利用し、任意の角度指令に対して生成される本角速度指令の角速度変化率および角加速度の制限を、別途検出した駆動時の負荷の周囲温度に応じて自動調整する。そのため、駆動機構のモータ軸換算イナーシャ、モータ軸角速度および加速時間で算出される加速トルクと、駆動機構特有の摩擦に代表される負荷トルクとの和が、モータ固有のトルク特性に一定のマージンを持たせた設計トルクの範囲内になるように本角速度指令を生成するため、脱調しない駆動を実現することができる。 In addition, the estimated angle of the step motor is used for feedback control, and the angular velocity change rate and angular acceleration limit of the actual angular velocity command generated for an arbitrary angle command are determined according to the separately detected ambient temperature of the load during driving. Adjust automatically. Therefore, the sum of the acceleration torque calculated by the motor shaft equivalent inertia of the drive mechanism, the motor shaft angular velocity and the acceleration time, and the load torque typified by the friction unique to the drive mechanism provides a certain margin for the torque characteristics unique to the motor. Since the actual angular velocity command is generated so as to be within the range of the designed torque, it is possible to realize driving without step-out.

さらに、ステップモータの推定角度をフィードバック制御に利用することで、モータ軸回転角や駆動機構の出力軸回転角を検出するための回転角センサ等、付加的なセンサを不要とすることができ、あらかじめ速度テーブルを用意する必要もないので、ハードウェアおよびソフトウェア構成ともに簡素化することができる。 Furthermore, by using the estimated angle of the step motor for feedback control, an additional sensor such as a rotation angle sensor for detecting the rotation angle of the motor shaft and the output shaft of the drive mechanism can be made unnecessary. Since it is not necessary to prepare a speed table in advance, both the hardware and software configuration can be simplified.

また、第１制御器におけるパラメータおよび飽和器におけるパラメータを、周囲温度に基づいて可変とすることにより、負荷の周囲温度を利用して、中間角速度指令の角速度変化率および角加速度指令の制限を自動調整することができる。そのため、特に低温で増大する負荷トルクに対して、加速時間を延ばすことによる加速トルク低減、または最大角速度の制限によるトルク範囲の拡大を図ることができ、脱調しない駆動を実現することができる。 Also, by making the parameter in the first controller and the parameter in the saturator variable based on the ambient temperature, the angular velocity change rate of the intermediate angular velocity command and the limitation on the angular acceleration command are automatically utilized using the ambient temperature of the load. Can be adjusted. Therefore, especially for load torque that increases at low temperatures, acceleration torque can be reduced by extending the acceleration time, or the torque range can be expanded by limiting the maximum angular velocity, and driving without step-out can be realized.

実施の形態２．
図５は、この発明の実施の形態２に係るステップモータ制御装置を、モータ駆動回路、ステップモータ、駆動機構および温度検出部とともに示すブロック構成図である。図５において、上述した実施の形態１との違いは、ステップモータ制御装置１Ｂ内の駆動演算部３０Ｂの演算内容が異なることである。Embodiment 2. FIG.
FIG. 5 is a block configuration diagram showing a step motor control device according to Embodiment 2 of the present invention together with a motor drive circuit, a step motor, a drive mechanism, and a temperature detection unit. In FIG. 5, the difference from the above-described first embodiment is that the calculation content of the drive calculation unit 30B in the step motor control device 1B is different.

また、上記実施の形態１では、ステップモータ３００を角度指令の全区間でフルステップ駆動させることを前提としていたが、この実施の形態２では、推定角度の閾値に応じてフルステップ駆動とマイクロステップ駆動とを切り換えることを特徴とする。 In the first embodiment, it is assumed that the step motor 300 is driven at full step in all sections of the angle command. However, in the second embodiment, full step drive and micro step are performed according to the estimated angle threshold. It is characterized by switching between driving.

続いて、図６、７を参照しながら、駆動演算部３０Ｂの処理について説明する。図６は、この発明の実施の形態２に係る駆動演算部の全体処理を示すフローチャートであり、図７は、この発明の実施の形態２に係る駆動演算部の励磁切換・電流振幅指令演算処理およびパルス周期演算処理を示すフローチャートである。 Next, the processing of the drive calculation unit 30B will be described with reference to FIGS. FIG. 6 is a flowchart showing the overall processing of the drive calculation unit according to Embodiment 2 of the present invention, and FIG. 7 shows excitation switching / current amplitude command calculation processing of the drive calculation unit according to Embodiment 2 of the present invention. It is a flowchart which shows a pulse period calculation process.

駆動演算部３０Ｂは、本角速度指令ωｃｏｍに基づいて、速度指令パルス、回転方向指令、励磁切換指令、電流振幅指令および速度指令パルスをカウントすることで得られる速度指令パルスカウント値、すなわち推定角度を出力する。なお、図６において、角速度正負判定、速度パルス停止、正転指令生成、反転指令生成、速度パルス生成および速度パルスカウント処理は、上述した実施の形態１と同一なので説明を省略する。 The drive calculation unit 30B calculates a speed command pulse count value obtained by counting a speed command pulse, a rotation direction command, an excitation switching command, a current amplitude command, and a speed command pulse, that is, an estimated angle, based on the main angular speed command ωcom. Output. In FIG. 6, the angular velocity positive / negative determination, the speed pulse stop, the forward rotation command generation, the reverse command generation, the speed pulse generation, and the speed pulse count processing are the same as those in the above-described first embodiment, and thus description thereof is omitted.

図６のステップＳ１００において、速度指令パルスのカウント値である推定角度θｅｓｔに基づいて、ステップモータ３００の励磁切換指令および電流振幅指令を生成する。以下、その生成方法について説明する。 In step S100 of FIG. 6, an excitation switching command and a current amplitude command for step motor 300 are generated based on estimated angle θest which is a count value of speed command pulses. Hereinafter, the generation method will be described.

まず、ステップモータ３００では、ステップモータ３００の各相の巻線へ流す電流を正弦波に近づけていくことで、ステップモータ固有のステップ角を電気的に高分解能化するマイクロステップ駆動と呼ばれる制御方式が知られている。 First, in the step motor 300, a control method called micro-step drive that electrically increases the resolution of the step angle unique to the step motor by causing the current flowing through the windings of each phase of the step motor 300 to approach a sine wave. It has been known.

一方、例えば駆動機構４００にカメラが搭載された機器においては、あらかじめ指定された撮影ポイントに向けてカメラを旋回させるプリセット動作と呼ばれる動作モードが設けられており、撮影ポイントへ高精度に位置決めすることが求められる。 On the other hand, for example, in a device in which the camera is mounted on the drive mechanism 400, an operation mode called a preset operation for turning the camera toward a predetermined shooting point is provided, and positioning to the shooting point with high accuracy is provided. Is required.

しかしながら、マイクロステップ駆動では、矩形波電流を流して駆動するフルステップ駆動と比較して、トルクが１／√２倍に低下する。そのため、位置決め用途として停止位置の近傍でマイクロステップ駆動を適用する際には、フルステップ駆動相当の電流を流し、フルステップ駆動とマイクロステップ駆動とを切り換えて駆動する場合のトルク変動を抑制する必要がある。 However, in the micro step drive, the torque is reduced to 1 / √2 times as compared with the full step drive in which the rectangular wave current is supplied. Therefore, when applying micro-step drive near the stop position for positioning applications, it is necessary to flow a current equivalent to full-step drive and suppress torque fluctuations when switching between full-step drive and micro-step drive. There is.

そこで、図７に示した励磁切換・電流振幅指令演算処理およびパルス周期演算処理により、フルステップ駆動とマイクロステップ駆動との励磁切換指令および電流振幅指令を生成する。すなわち、推定角度による閾値判定を行い、フルステップ駆動とマイクロステップ駆動とを分岐させる（ステップＳ１０５）。 Therefore, an excitation switching command and a current amplitude command between full-step driving and micro-step driving are generated by the excitation switching / current amplitude command calculation processing and pulse period calculation processing shown in FIG. That is, the threshold value is determined based on the estimated angle, and the full step drive and the micro step drive are branched (step S105).

このとき、ステップＳ１０５におけるフルステップ駆動とマイクロステップ駆動との分岐条件には、速度指令パルスのカウント値である推定角度θｅｓｔ、角度指令の最終値θｅｎｄ、あらかじめ設定された角度閾値θｔｈ１および角度閾値θｔｈ２を用いる。なお、始動側のマイクロステップ駆動区間をθｔｈ１の絶対値｜θｔｈ１｜で区別し、停止側のマイクロステップ駆動区間を角度指令の最終値θｅｎｄとθｔｈ２との差分の絶対値｜θｅｎｄ−θｔｈ２｜で区別する。 At this time, the branching condition between the full step driving and the micro step driving in step S105 includes the estimated angle θest which is the count value of the speed command pulse, the final value θend of the angle command, the preset angle threshold θth1 and the angle threshold θth2 Is used. The start-side microstep drive section is distinguished by the absolute value | θth1 | of θth1, and the stop-side microstep drive section is distinguished by the absolute value | θend−θth2 | of the difference between the final values θend and θth2 of the angle command. To do.

ここで、図８を参照しながら、角度閾値の設定について説明する。図８は、この発明の実施の形態２に係るステップモータのフルステップ駆動時およびマイクロステップ駆動時の電流ベクトルを示す説明図であり、２相のステップモータを使用する場合について示している。図８において、横軸および縦軸は、それぞれＡ相およびＢ相の定格電流に対する実電流の比として無次元化した電流比を示している。 Here, the setting of the angle threshold will be described with reference to FIG. FIG. 8 is an explanatory diagram showing current vectors at the time of full-step driving and micro-step driving of the step motor according to Embodiment 2 of the present invention, and shows a case where a two-phase step motor is used. In FIG. 8, the horizontal axis and the vertical axis indicate the dimensionless current ratio as the ratio of the actual current to the A-phase and B-phase rated currents, respectively.

フルステップ駆動の場合、図８の実線矢印で示すように、Ａ相およびＢ相には、それぞれ電流位相が９０°ずれた矩形波電流を流すため、Ａ相電流ベクトルとＢ相電流ベクトルとで合成された電流ベクトルは、Ｄ１、Ｄ２、Ｄ３、Ｄ４の４ポイントを取り、このときの各ポイント間の位相差がステップモータ３００のステップ角に相当する。 In the case of full-step drive, as indicated by solid arrows in FIG. 8, a rectangular wave current having a current phase shifted by 90 ° flows in the A phase and the B phase. The synthesized current vector takes four points D1, D2, D3, and D4, and the phase difference between each point at this time corresponds to the step angle of the step motor 300.

一方、マイクロステップの一例であるハーフステップ駆動の場合、図８の破線矢印で示すように、電流ベクトルは、フルステップ駆動の電流ベクトルの位相を２分割したＭ１、Ｍ２、Ｍ３、Ｍ４、Ｍ５、Ｍ６、Ｍ７、Ｍ８の８ポイントを取る。 On the other hand, in the case of half-step driving, which is an example of a microstep, as indicated by the broken-line arrows in FIG. 8, the current vectors are M1, M2, M3, M4, M5, Take 8 points M6, M7, M8.

このように、ステップモータをフルステップ駆動とマイクロステップ駆動とで切り換える場合、双方の電流ベクトルが一致する方向で励磁切換を行う必要があることが分かる。つまり、上述したフルステップ駆動時とマイクロステップ駆動時との電流ベクトルがともに一致した方向、すなわち図８内のＭ２、Ｍ４、Ｍ６、Ｍ８で切り換えを行えば、フルステップ駆動とマイクロステップ駆動とを途中で切り換えても、ステップモータ回転軸の正確な歩進動作を実現することができる。 Thus, when the step motor is switched between full step driving and micro step driving, it is understood that it is necessary to perform excitation switching in a direction in which both current vectors coincide. That is, if switching is performed in the direction in which the current vectors in full step driving and micro step driving described above coincide, that is, in M2, M4, M6, and M8 in FIG. 8, full step driving and micro step driving are performed. Even if switching is performed in the middle, an accurate stepping operation of the step motor rotating shaft can be realized.

なお、図８では、フルステップ駆動の電流ベクトルの位相を２分割するハーフステップ駆動の電流ベクトルを一例として示したが、これに限定されず、ｎ（ｎは２以上の偶数）分割以上のマイクロステップ駆動をフルステップ駆動と切り換えて駆動する場合であっても、同様にフルステップ駆動時の電流ベクトルＤ１、Ｄ２、Ｄ３、Ｄ４と一致する方向で励磁切換を実施することにより、ステップモータ回転軸の正確な歩進動作を実現することができる。 In FIG. 8, a half-step drive current vector that divides the phase of a full-step drive current vector into two is shown as an example. However, the present invention is not limited to this. Even when step driving is switched to full step driving, similarly, excitation switching is performed in a direction that coincides with the current vectors D1, D2, D3, and D4 during full step driving. It is possible to realize an accurate step movement.

すなわち、角度閾値θｔｈは、フルステップ駆動とマイクロステップ駆動との電流ベクトルが一致する角度を設定すればよい。さらに、フルステップ駆動を用いることなく、マイクロステップ駆動で、分割数のみを切り換えて駆動する場合には、切換前のマイクロステップ駆動の電流ベクトルが、切換後のマイクロステップ駆動の電流ベクトルと一致する方向で励磁切換を実施すればよい。 That is, the angle threshold θth may be set to an angle at which the current vectors of full step driving and microstep driving match. Further, when driving by switching only the number of divisions by microstep driving without using full step driving, the current vector of microstep driving before switching matches the current vector of microstep driving after switching. Excitation switching may be performed in the direction.

図７に戻って、ステップＳ１０５において、推定角度の絶対値｜θｅｓｔ｜が始動側の角度閾値の絶対値｜θｔｈ１｜よりも大きく、停止側の角度閾値の絶対値｜θｅｎｄ−θｔｈ２｜未満の場合、フルステップ励磁切換を行い、フルステップ励磁切換指令を生成して出力する（ステップＳ１１０）。 Returning to FIG. 7, in step S105, the absolute value | θest | of the estimated angle is larger than the absolute value | θth1 | of the start-side angle threshold and less than the absolute value | θend−θth2 | Then, full step excitation switching is performed to generate and output a full step excitation switching command (step S110).

また、Ａ相およびＢ相の電流振幅を、後述するＳＴ１３０における設定値Ａｍｐ＿ｍｉｃｒｏに対して１／√２倍に縮小した電流振幅指令Ａｍｐ＿ｆｕｌｌを生成して出力する（ステップＳ１１５）。すなわち、Ａｍｐ＿ｆｕｌｌ＝Ａｍｐ＿ｍｉｃｒｏ／√２である。 Further, a current amplitude command Amp_full in which the current amplitudes of the A phase and the B phase are reduced by 1 / √2 times the set value Amp_micro in ST 130 described later is generated and output (step S115). That is, Amp_full = Amp_micro / √2.

続いて、速度指令パルスのパルス周期ｔｐを演算する（ステップＳ１２０）。このとき、演算方法は、上記実施の形態１で示した式（４）と同一の式を用いて演算する。 Subsequently, the pulse period tp of the speed command pulse is calculated (step S120). At this time, the calculation method is calculated using the same formula as the formula (4) shown in the first embodiment.

次に、ステップＳ１２０で演算されたパルス周期ｔｐに基づいて、速度指令パルスを生成し、生成された速度指令パルスを、パルスのアップエッジまたはダウンエッジの何れかでカウントする（図６参照）。 Next, based on the pulse period tp calculated in step S120, a speed command pulse is generated, and the generated speed command pulse is counted at either the up edge or the down edge of the pulse (see FIG. 6).

このとき、角度指令の最終値までカウントした時点で、カウント値を０にリセットする。なお、この速度指令パルスの１パルス分は、ステップモータ３００のステップ角θｓに相当する。 At this time, the count value is reset to 0 when the angle command is counted to the final value. Note that one pulse of the speed command pulse corresponds to the step angle θs of the step motor 300.

一方、ＳＴ１０５において、推定角度の絶対値｜θｅｓｔ｜が始動側の角度閾値の絶対値｜θｔｈ１｜以下であるか、または停止側の角度閾値の絶対値｜θｅｎｄ−θｔｈ２｜以上の場合、マイクロステップ励磁切換を行い、マイクロステップ励磁切換指令を生成して出力する（ステップＳ１２５）。 On the other hand, when the absolute value | θest | of the estimated angle is equal to or smaller than the absolute value | θth1 | of the angle threshold on the start side or greater than the absolute value | θend−θth2 | Excitation switching is performed to generate and output a microstep excitation switching command (step S125).

また、Ａ相およびＢ相の電流振幅を、Ａｍｐ＿ｆｕｌｌに対して√２倍に拡大した電流振幅指令Ａｍｐ＿ｍｉｃｒｏを生成して出力する（ステップＳ１３０）。 Also, a current amplitude command Amp_micro in which the current amplitudes of the A phase and the B phase are expanded by √2 times with respect to Amp_full is generated and output (step S130).

続いて、速度指令パルスのパルス周期ｔｐｍを演算するが、フルステップ駆動時と等価な速度を実現するために、次式（５）によりパルス周期ｔｐｍを演算する（ステップＳ１３５）。式（５）において、ｎ（ｎは２以上の偶数）は、マイクロステップ駆動の分割数であって、例えばｎ＝２の場合は、ハーフステップ駆動に相当する。 Subsequently, the pulse period tpm of the speed command pulse is calculated. In order to realize a speed equivalent to that at the time of full step driving, the pulse period tpm is calculated by the following equation (5) (step S135). In Expression (5), n (n is an even number of 2 or more) is the number of divisions of microstep driving. For example, when n = 2, it corresponds to half step driving.

次に、ステップＳ１３５で演算されたパルス周期ｔｐｍに基づいて、速度指令パルスを生成し、生成された速度指令パルスを、パルスのアップエッジまたはダウンエッジの何れかでカウントする（図６参照）。 Next, based on the pulse period tpm calculated in step S135, a speed command pulse is generated, and the generated speed command pulse is counted at either the up edge or the down edge of the pulse (see FIG. 6).

このとき、角度指令の最終値までカウントした時点で、カウント値を０にリセットする。なお、この速度指令パルスの１パルス分は、ステップモータ３００のステップ角θｓの１／ｎ倍に相当する。 At this time, the count value is reset to 0 when the angle command is counted to the final value. Note that one pulse of the speed command pulse corresponds to 1 / n times the step angle θs of the step motor 300.

以上のように、実施の形態２によれば、推定角度の閾値に応じてステップモータをフルステップ駆動とステップモータ特有のマイクロステップ駆動とで切り換えて駆動するとともに、マイクロステップ駆動に切り換えた場合のモータトルクの低下を抑制することで、振動の小さい滑らかな始動および停止、並びに駆動機構の所定角度への高精度な位置決めを実現することができる。 As described above, according to the second embodiment, the step motor is switched between full step driving and micro step driving unique to the step motor according to the threshold value of the estimated angle, and is switched to micro step driving. By suppressing the decrease in the motor torque, it is possible to realize smooth start and stop with small vibration and high-precision positioning of the drive mechanism at a predetermined angle.

さらに、駆動演算部３０Ｂで生成された速度指令パルスを、パルスのアップエッジまたはダウンエッジの何れかでカウントしたステップモータ３００の推定角度θｅｓｔを速度指令演算部２０への角度フィードバックへ利用し、速度指令演算部２０では、温度検出部５００にて得られた負荷の周囲温度Ｔに基づいて、ステップモータ３００の設計トルク以下となるように角速度変化率および角加速度の制限を自動調整した本角速度指令を生成できるので、トルクマージンを低下させることなく、ステップモータを脱調させない駆動を実現することができる。 Further, the estimated angle θest of the step motor 300 obtained by counting the speed command pulse generated by the drive calculation unit 30B at either the up edge or the down edge of the pulse is used for the angle feedback to the speed command calculation unit 20, and the speed command pulse is generated. In the command calculation unit 20, based on the ambient temperature T of the load obtained by the temperature detection unit 500, the angular velocity command that automatically adjusts the angular velocity change rate and the angular acceleration limit so as to be equal to or less than the design torque of the step motor 300. Therefore, it is possible to realize driving that does not step out the step motor without reducing the torque margin.

実施の形態３．
図９は、この発明の実施の形態３に係るステップモータ制御装置を、モータ駆動回路、ステップモータ、駆動機構、温度検出部および外部インターフェースとともに示すブロック構成図である。図９において、上述した実施の形態１との違いは、外部インターフェース６００が追加された点である。Embodiment 3 FIG.
FIG. 9 is a block configuration diagram showing the step motor control device according to the third embodiment of the present invention together with a motor drive circuit, a step motor, a drive mechanism, a temperature detection unit, and an external interface. In FIG. 9, the difference from the first embodiment described above is that an external interface 600 is added.

外部インターフェース６００は、角度指令演算部１０Ａへ操作指令を出力し、角度指令演算部１０Ａで操作指令が角度指令θｃｏｍに変換される。外部インターフェース６００は、例えばジョイスティック等であってもよい。このようにすることで、実施の形態１の効果に加えて、ステップモータ制御装置を、マンマシンインターフェース、すなわちユーザーが思いのままに操作できる装置としても活用することができる。 The external interface 600 outputs an operation command to the angle command calculation unit 10A, and the angle command calculation unit 10A converts the operation command into an angle command θcom. The external interface 600 may be, for example, a joystick. In this way, in addition to the effects of the first embodiment, the step motor control device can be utilized as a man-machine interface, that is, a device that can be operated as desired by the user.

実施の形態４．
図１０は、この発明の実施の形態４に係るステップモータ制御装置を、モータ駆動回路、ステップモータ、駆動機構、温度検出部および外部インターフェースとともに示すブロック構成図である。図１０において、上述した実施の形態２との違いは、外部インターフェース６００が追加された点である。Embodiment 4 FIG.
FIG. 10 is a block configuration diagram showing a step motor control apparatus according to Embodiment 4 of the present invention, together with a motor drive circuit, a step motor, a drive mechanism, a temperature detection unit, and an external interface. In FIG. 10, the difference from the above-described second embodiment is that an external interface 600 is added.

外部インターフェース６００は、角度指令演算部１０Ａへ操作指令を出力し、角度指令演算部１０Ａで操作指令が角度指令θｃｏｍに変換される。外部インターフェース６００は、例えばジョイスティック等であってもよい。このようにすることで、実施の形態２の効果に加えて、ステップモータ制御装置を、マンマシンインターフェース、すなわちユーザーが思いのままに操作できる装置としても活用することができる。 The external interface 600 outputs an operation command to the angle command calculation unit 10A, and the angle command calculation unit 10A converts the operation command into an angle command θcom. The external interface 600 may be, for example, a joystick. In this way, in addition to the effects of the second embodiment, the step motor control device can be utilized as a man-machine interface, that is, a device that can be operated as desired by the user.

１Ａ、１Ｂステップモータ制御装置、１０、１０Ａ角度指令演算部、２０速度指令演算部、２１第１制御器、２２飽和器、２３第２制御器、３０Ａ、３０Ｂ駆動演算部、２００モータ駆動回路、３００ステップモータ、４００駆動機構、５００温度検出部、６００外部インターフェース（マンマシンインターフェース）。 1A, 1B step motor control device, 10, 10A angle command calculation unit, 20 speed command calculation unit, 21 first controller, 22 saturator, 23 second controller, 30A, 30B drive calculation unit, 200 motor drive circuit, 300 step motor, 400 drive mechanism, 500 temperature detector, 600 external interface (man machine interface).

Claims

角度指令に基づいてステップモータの角度制御を行うステップモータ制御装置であって、
前記ステップモータに対する前記角度指令を出力する角度指令演算部と、
前記角度指令演算部の出力である前記角度指令および温度検出部で検出された周囲温度に基づいて、本角速度指令を演算する速度指令演算部と、
前記速度指令演算部の出力である前記本角速度指令に基づいて、前記ステップモータに対する速度指令パルスを生成するとともに、前記速度指令パルスを加算して推定角度を演算して前記推定角度を前記速度指令演算部にフィードバックする駆動演算部と、を備え、
前記速度指令演算部は、前記推定角度に基づいて前記本角速度指令を演算して前記本角速度指令を出力する
ステップモータ制御装置。A step motor control device that performs angle control of a step motor based on an angle command,
An angle command calculation unit that outputs the angle command for the step motor;
A speed command calculation unit that calculates the angular speed command based on the angle command that is an output of the angle command calculation unit and the ambient temperature detected by the temperature detection unit;
A speed command pulse for the step motor is generated based on the main angular speed command, which is an output of the speed command calculation unit, and the estimated angle is calculated by adding the speed command pulse to calculate the estimated angle. A drive calculation unit that feeds back to the calculation unit,
The step motor control device, wherein the speed command calculation unit calculates the main angular speed command based on the estimated angle and outputs the main angular speed command.

前記駆動演算部は、演算した前記推定角度および前記本角速度指令に基づいて、前記速度指令パルスを生成する
請求項１に記載のステップモータ制御装置。The step motor control device according to claim 1, wherein the drive calculation unit generates the speed command pulse based on the calculated estimated angle and the actual angular speed command.

前記速度指令演算部は、前記角度指令演算部の出力である前記角度指令から、前記駆動演算部の出力である前記推定角度を減算することで得られる角度偏差と、前記周囲温度とに基づいて、中間角速度指令を出力する第１制御器と、
前記中間角速度指令から前記本角速度指令を減算した速度偏差に基づいて、角加速度の上下限制限値を演算する飽和器と、
前記角加速度の上下限制限値に基づいて、前記本角速度指令を演算する第２制御器と、
を有する請求項１または請求項２に記載のステップモータ制御装置。The speed command calculation unit is based on an angular deviation obtained by subtracting the estimated angle, which is an output of the drive calculation unit, from the angle command, which is an output of the angle command calculation unit, and the ambient temperature. A first controller for outputting an intermediate angular velocity command;
Based on a speed deviation obtained by subtracting the main angular velocity command from the intermediate angular velocity command, a saturator that calculates upper and lower limit values of angular acceleration,
A second controller for calculating the main angular velocity command based on upper and lower limit values of the angular acceleration;
The step motor control device according to claim 1, comprising:

前記第１制御器を構成するパラメータおよび前記飽和器のパラメータを、前記周囲温度に基づいて可変とする
請求項３に記載のステップモータ制御装置。The step motor control device according to claim 3, wherein a parameter configuring the first controller and a parameter of the saturator are variable based on the ambient temperature.

前記駆動演算部は、前記本角速度指令および前記推定角度に基づいて、前記ステップモータのフルステップ駆動とマイクロステップ駆動との励磁を切り換える
請求項１から請求項４までの何れか１項に記載のステップモータ制御装置。The said drive calculating part switches excitation with the full step drive of the said step motor, and a microstep drive based on the said main angular velocity command and the said estimated angle, The any one of Claim 1- Claim 4 Step motor control device.

前記角度指令演算部は、外部インターフェースからの操作指令を前記角度指令に変換する
請求項１から請求項５までの何れか１項に記載のステップモータ制御装置。The step motor control device according to any one of claims 1 to 5, wherein the angle command calculation unit converts an operation command from an external interface into the angle command.

角度指令に基づいてステップモータの角度制御を行うステップモータ制御装置で実現されるステップモータ制御方法であって、
前記ステップモータに対する前記角度指令を出力するステップと、
前記角度指令および周囲温度に基づいて、本角速度指令を演算するステップと、
前記本角速度指令に基づいて、前記ステップモータに対する速度指令パルスを生成するステップと、
前記速度指令パルスを加算して推定角度を演算するステップと、
前記推定角度を、前記本角速度指令を演算するステップにフィードバックさせるステップと、を有する
ステップモータ制御方法。A step motor control method realized by a step motor control device that performs angle control of a step motor based on an angle command,
Outputting the angle command for the step motor;
Calculating an angular velocity command based on the angle command and the ambient temperature;
Generating a speed command pulse for the step motor based on the main angular speed command;
Calculating the estimated angle by adding the speed command pulses;
Feeding back the estimated angle to the step of calculating the main angular velocity command.

前記速度指令パルスを生成するステップにおいて、演算した前記推定角度および前記本角速度指令に基づいて、前記速度指令パルスを生成する
請求項７に記載のステップモータ制御方法。The step motor control method according to claim 7, wherein in the step of generating the speed command pulse, the speed command pulse is generated based on the calculated estimated angle and the actual angular speed command.