JP3654049B2

JP3654049B2 - Motor control device

Info

Publication number: JP3654049B2
Application number: JP14185599A
Authority: JP
Inventors: 茂雄根木
Original assignee: Panasonic Corp; Matsushita Electric Industrial Co Ltd
Current assignee: Panasonic Corp; Panasonic Holdings Corp
Priority date: 1999-05-21
Filing date: 1999-05-21
Publication date: 2005-06-02
Anticipated expiration: 2019-05-21
Also published as: JP2000333483A

Description

【０００１】
【発明の属する技術分野】
本発明は、モータの速度を制御する制御装置に関するものである。
【０００２】
【従来の技術】
従来のモータの速度を制御する制御装置では、例えば起動スイッチをＯＮ／ＯＦＦして加速あるいは減速時に速度指令が急激に変化するような場合においても速度指令を変換しないで与えたり、あるいは一定の加速度指令で制限を加えていわゆる台形の速度指令に変換して与えて、モータの実速度との偏差に応じてモータの通電電流を制御する構成であった。
【０００３】
【発明が解決しようとする課題】
上記従来のモータの速度を制御する制御装置では、例えば速度指令が変化するとその変化に応じたモータ電流が流れ、特に急激に速度指令が大きく加速または減速方向に変化した場合には最大の加速電流または減速電流が流れたり、あるいは速度指令が定常状態に移行する場合や逆に定常状態から加速あるいは減速状態に切り替わる時点においてモータ電流が急に変化し、従って負荷に対して過大なトルク変化を生じるという不具合があった。
【０００４】
本発明は上記の課題を解決するもので、簡単な構成および計算により速度指令入力の急激な変化に対し滑らかな速度指令と電流・トルク変化が得られるモータ制御装置を提供することを目的とする。
【０００５】
【課題を解決するための手段】
この課題を解決するために本発明のモータ制御装置は、一定の周期のサンプリング周期毎に処理を行うディジタルモータ制御システムにおいて、速度指令入力と比較して台形の加速度指令を決定し、この加速度指令を基に速度指令を台形＋Ｓ字の速度指令として変換し出力する変換手段と、実速度との偏差に応じてモータへの通電電流を制御するモータ制御手段を備えている。
【０００６】
【発明の実施の形態】
本発明の請求項１に記載の発明は、一定の周期を持ったサンプリング信号を出力する発振器と、アナログ信号をディジタル信号に変換し速度指令を出力するＡ／Ｄ変換器と、速度指令を変換して速度指令１を出力する変換手段と、モータの回転位置を検出する回転位置検出器と、回転位置検出信号を計数して実速度信号を出力する実速度測定手段と、前記速度指令１と実速度信号を比較してモータの通電電流を制御するモータ制御手段とより成り、前記変換手段は制御パラメータを記憶したメモリと加速度設定手段と速度指令変換手段を含み、前記メモリは規定の速度Ｓｒに到達するに要する時間Ｔａと、規定の速度Ｓｒから停止するに要する時間Ｔｄと、サンプリング周期Ｔｓ毎に最大加速および最大減速において加速度指令が変化する時間Ｔ１とを備え、前記加速度設定手段はステップ数演算手段により最大ステップ数ＱｍをＱｍ＝Ｔ１／Ｔｓなる計算式で求め、第１の演算手段により加速時の加加速度指令ΔＡａをΔＡａ＝Ｓｒ／（Ｔａ×Ｑｍ）なる計算式で求め、第２の演算手段により減速時の加加速度指令ΔＡｄをΔＡｄ＝Ｓｒ／（Ｔｄ×Ｑｍ）なる計算式で求め、速度指令変換手段によりサンプリング周期毎に現在ステップ数Ｑ０に前記Ｑｍの制限のもとで０、＋１、−１を加算して３通りのステップ数Ｑｋを算出し、各々のＱｋについて加速度指令が０になる時点での到達速度指令を計算し、到達速度指令と速度指令入力との比較により次のサンプリング周期におけるステップ数Ｑｋおよび速度指令１を決定し出力するよう構成されており、加速時と減速時の加加速度指令を独立して演算して設定された通りのＳ字時間幅と加速度を備えた台形＋Ｓ字の速度指令が得られるようになり、滑らかな速度指令に基づく電流制御が行われるディジタルモータ制御システムを構築することが可能となる。
【０００７】
本発明の請求項２に記載の発明は、速度指令変換手段はサンプリング周期毎に新速度指令Ｖｋを現在速度指令Ｖ０を基準として加速時はＶｋ＝Ｖ０＋ΔＡａ×Ｑｋなる式で、減速時はＶｋ＝Ｖ０＋ΔＡｄ×｜Ｑｋ｜なる式で計算し出力するようにした構成であり、比較的簡単な計算式により加加速度指令とステップ数から速度指令に変換されるようになる。
【０００８】
本発明の請求項３に記載の発明は、速度指令変換手段は到達速度指令Ｖｄを加速時はＶｄ＝Ｖ０＋ΔＡａ×Ｑｋ×（Ｑｋ＋１）／２なる式で、減速時はＶｄ＝Ｖ０＋ΔＡｄ×｜Ｑｋ｜×（｜Ｑｋ｜＋１）／２なる式で求めるようにした構成であり、加速時と減速時と別の加加速度に従って簡単な計算式で最短時間で加速度が０になる時点の到達速度を計算することが可能となる。
【０００９】
【実施例】
以下、本発明の実施例について、図１を用いて説明する。
【００１０】
図１は本発明の一実施例におけるブロック図を示すものである。
【００１１】
１は速度指令を設定するボリュームであり０Ｖ〜Ｖｃの速度指令電圧をＡ／Ｄ変換器２に入力する。３はモータ４の駆動・停止を指令するスイッチであり、ＯＮにすると速度指令電圧を０Ｖに固定し停止を指令し、ＯＦＦにすると起動を指令する。５はＡ／Ｄ変換器からのディジタルに変換された速度指令を受けて発振器６からの一定の周期Ｔｓを持ったパルス状のサンプリング信号に同期してサンプリング周期Ｔｓ間の速度指令に変換して速度指令１を出力する変換手段を示し、７はモータ４への通電電流を制御するモータ制御手段であり、８はモータ軸の回転位置を検出する回転位置検出器９からのパルス状の回転位置信号を前記サンプリング周期間計数してモータの実速度信号を出力する速度測定手段を示し、上記変換手段５、モータ制御手段７の制御部および速度測定手段８は通常マイクロコンピュータによって制御される。
【００１２】
上記のように構成された本発明の動作について図２のタイムチャートを参照して以下に述べる。
【００１３】
まず、作業者によりスイッチ３がＯＦＦにされるとモータ４はボリューム１で設定された速度指令入力Ｓｍに向かって起動される。変換手段５は台形の加速度指令で近似される加速度指令をもとに速度指令入力Ｓｍと比較してサンプリング周期Ｔｓ毎の速度指令１に変換し出力する。すなわち、サンプリング周期Ｔｓ毎に許容される加速度指令の変化値を所定の単位ステップの加加速度として規定しかつ最大加速度指令を加加速度指令の倍数のステップ数として規定して、加速度指令が０になる時点の到達速度指令を演算し、この演算結果と速度指令入力Ｓｍとの比較により次のサンプリング周期間の加速度指令を決定し、この加速度指令を基に速度指令１を演算し出力するように処理され、上記単位ステップの加加速度指令がサンプリング周期毎に変化している加速度指令の区間がＳ字速度指令となり、最大加速度指令で制限されている区間が台形速度指令の脚部に相当する速度指令となる。このようにして、Ｓ字→台形（脚部）→Ｓ字→台形（Ｓｍ）の加速における速度指令パターンが速度指令１として変換器５により変換されて出力され、モータ制御手段７は速度指令信号１と速度測定手段８からの実速度信号との偏差に応じてモータ４への通電電流を制御し速度指令１に略等しい実速度パターンが得られるように動作が行われる。一方、スイッチ１がＯＮされると速度指令入力Ｓｍは０となるので加速度は負となり、前記と同様にして速度０に向けてＳ字→台形（脚部）→Ｓ字→速度０の減速における速度指令パターンが得られる。
【００１４】
ここで、上記変換手段５は図３に示すようにメモリ１０および加速度設定手段１１および速度指令変換手段１２とで構成されており、以下に図３について説明する。
【００１５】
メモリ１０は通常電源をオフしてもデータが消えないような不揮発性のメモリが使用され、制御パラメータとして図２のタイムチャートにも示されるようにＳ字速度指令時間Ｔ１、加速時間Ｔａ、減速時間Ｔｄがオペレータにより設定される。ここで加速時間Ｔａおよび減速時間Ｔｄは、図２においては速度指令入力Ｓｍと停止間の時間として表されているが通常上記速度指令入力Ｓｍではなく規定の速度Ｓｒとしてメモリ１０の制御パラメータに含められた値が用いられ、即ち加速時間Ｔａおよび減速時間Ｔｄは加速度を表す制御パラメータに相当するものとしている。
【００１６】
次に加速度設定手段１１の動作について図４のブロック図を参照して述べる。
【００１７】
オペレータにより、負荷の加減速特性に合わせてその滑らかさがＳ字区間の速度指令時間Ｔ１として設定されるとシステムのサンプリング周期Ｔｓとにより、ステップ数演算手段１３で最大ステップ数ＱｍがＱｍ＝Ｔ１／Ｔｓにより計算され出力される。ここで最大ステップ数Ｑｍは後述する量子化された加加速度指令ΔＡのステップ数として整数値に丸められる。一方、制御パラメータの一つである規定の速度Ｓｒまでの加速時間Ｔａが設定されると、第１の加加速度演算手段１４により加速時の加加速度指令ΔＡａはΔＡａ＝Ｓｒ／（Ｔａ×Ｑｍ）で計算され出力される。即ち加速時の加加速度指令ΔＡａは、サンプリング周期Ｔｓ毎に加速度指令が変化し得る値を示すものである。また同様にして、第２の加加速度演算手段１５により減速時の加加速度指令ΔＡｄはΔＡｄ＝Ｓｒ／（Ｔｄ×Ｑｍ）で計算され出力される。
【００１８】
以上のようにして、最大ステップ数Ｑｍ、加速時の加加速度指令ΔＡａおよび減速時の加加速度指令ΔＡｄが決定され、ステップ数確定手段１６により速度指令入力Ｓｍとの比較においてステップ数Ｑｋが決定されることになるがこの点について以下に図５（ａ）、（ｂ）および図６を用いて説明を加える。
【００１９】
図５は速度指令変換手段の速度指令への変換処理を示すタイムチャートであり（ａ）は加速時、（ｂ）は減速時を示しており、同様に図６はフローチャートを示す。
【００２０】
図５において、加速度指令は量子化された加速時の加加速度指令ΔＡａを単位ステップとして階段状に表されており、サンプリング周期Ｔｓ毎の変化は単位ステップに相当する加加速度指令ΔＡａで制限されて更新され、また現在のステップ数をＱ０としている。なお、ｙ軸の加速度指令は単位ステップに相当する加速時の加加速度指令ΔＡａ（正の値）にステップ数Ｑの絶対値を乗じた値となり正の領域となる。一方、速度指令はサンプリング周期Ｔｓ毎に上記加速度指令を現在速度指令Ｖ０に加えることにより得られる。ここで、サンプリング周期Ｔｓ毎の加速度指令の変化は単位ステップの加加速度指令ΔＡとして制限されているため現在加速度ステップ数Ｑ０を基準とすれば新加速度ステップ数ＱｋはＱ０＋１，Ｑ０，Ｑ０−１のいずれかとなり、また新速度指令Ｖｋは、
Ｖｋ＝Ｖ０＋ΔＡａ×Ｑｋ ―――（１）となり、さらに引き続き最短時間で加速度指令が０に至るまでの加速度指令パターンおよび速度指令パターンを同図に示している。ここで加速度指令が０に至る時点での到達速度指令Ｖｄは、現在速度指令Ｖ０に加速度指令の積分値として表される変化速度指令Ｖｃを加算することにより得られ、即ち新加速度ステップ数をＱｋとすれば、
Ｖｄ＝Ｖ０＋ΔＡａ×Ｑｋ×（Ｑｋ＋１）／２ ―――（２）となる。
【００２１】
上述した３通りの新加速度について（２）式に代入し、到達速度指令Ｖｄを算出して速度指令入力Ｖｔと比較し、加速時には最大加速度指令パターンでまた減速時は最小加速度指令パターンでＶｔに最も近くかつＶｔ≧Ｖｄなる条件を満足する１つの新加速度指令Ｑｋを決定する。図５の実施例において決定される新加速度指令ステップ数Ｑｋの結果は、加速時・減速時ともＱｋ＝Ｑ０となる。
【００２２】
ここで、減速時の動作についても上述した加速時の動作と同様であるが、減速時の加加速度指令ΔＡｄは負の値でありステップ数は絶対値として計算され、加速度指令は負となり到達速度指令Ｖｄは（３）式により、新速度指令Ｖｋは（４）式により計算される。
【００２３】
Ｖｄ＝Ｖ０＋ΔＡｄ×｜Ｑｋ｜×（｜Ｑｋ｜＋１）／２ ―――（３）
Ｖｋ＝Ｖ０＋ΔＡｄ×｜Ｑｋ｜ ―――（４）
上述のようにして決定された新加速度ステップ数Ｑｋを基に加速時は（１）式に、減速時には（４）式に代入して新速度指令Ｖｋを算出し速度指令１として出力する。
【００２４】
上述した動作を図６のフローチャートに加速時と減速時に分けて記述しているが、特に新ステップ数Ｑｋが０の場合は速度指令は一定の定常状態となるが上記に述べた制御では速度指令入力と速度指令出力との間にディジタル化に伴う量子化誤差、すなわち加加速度指令ΔＡａおよびΔＡｄ以下の速度指令の変化には対応できないものとなる。そこで、本願発明では同図に示すように加速度指令が０（ステップ数が０）の場合には速度指令入力Ｓｍをそのまま出力する処理を行い、定常状態における速度指令誤差を０にしている。
【００２５】
【発明の効果】
以上のように本発明のモータ制御装置は、一定の周期のサンプリング周期毎に処理を行うディジタルモータ制御システムにおいて、台形の加速度指令で制限を加えて速度指令入力を台形＋Ｓ字の速度指令に変換する変換手段と、実速度との偏差に応じてモータへの通電電流を制御するモータ制御手段を備えており、本発明によれば簡単な構成および計算により速度指令入力の急激な変化に対し滑らかな速度指令に基づく電流制御が得られるようになる。
【００２６】
また、本発明によれば定常状態においてディジタル制御の量子化に伴う誤差を軽減し、速度指令に忠実な速度指令が得られるようになる。
【００２７】
さらに本発明によれば、加速時と減速時の加加速度指令を独立して演算するので設定された通りのＳ字字間幅と加速度指令を備えた台形＋Ｓ字の速度指令が得られるものとなる。
【図面の簡単な説明】
【図１】本発明の一実施例におけるモータ制御装置のブロック図
【図２】本発明の動作を示すタイムチャート
【図３】変換手段のブロック図
【図４】加速度設定手段処理を示すブロック図
【図５】（ａ）加速時の速度指令変換手段の動作を示すタイムチャート
（ｂ）減速時の速度指令変換手段の動作を示すタイムチャート
【図６】速度指令変換手段の動作を示すフローチャート
【符号の説明】
１ボリューム
２Ａ／Ｄ変換器
３スイッチ
４モータ
５変換手段
６発振器
７モータ制御手段
８速度測定手段
９回転位置検出器
１０メモリ
１１加速度設定手段
１２速度指令変換手段[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a control device that controls the speed of a motor.
[0002]
[Prior art]
In a conventional control device for controlling the speed of a motor, for example, even when the speed command changes suddenly during acceleration or deceleration by turning the start switch ON / OFF, the speed command is given without conversion or at a constant acceleration. It is a configuration in which the energization current of the motor is controlled according to a deviation from the actual speed of the motor by giving a restriction by the command and converting it to a so-called trapezoidal speed command.
[0003]
[Problems to be solved by the invention]
In the conventional control device for controlling the speed of the motor, for example, when the speed command changes, a motor current corresponding to the change flows, and particularly when the speed command greatly changes in the acceleration or deceleration direction, the maximum acceleration current is obtained. Or, when the deceleration current flows, or when the speed command shifts to the steady state, or conversely, the motor current changes suddenly when switching from the steady state to the acceleration or deceleration state, resulting in an excessive torque change with respect to the load. There was a problem that.
[0004]
SUMMARY OF THE INVENTION An object of the present invention is to provide a motor control device that can obtain a smooth speed command and current / torque change with respect to a sudden change in speed command input with a simple configuration and calculation. .
[0005]
[Means for Solving the Problems]
In order to solve this problem, a motor control device according to the present invention determines a trapezoidal acceleration command in comparison with a speed command input in a digital motor control system that performs processing at a sampling cycle of a fixed cycle. Conversion means for converting and outputting a speed command as a trapezoid + S-shaped speed command based on the above, and a motor control means for controlling a current supplied to the motor in accordance with a deviation from the actual speed.
[0006]
DETAILED DESCRIPTION OF THE INVENTION
According to the first aspect of the present invention, an oscillator that outputs a sampling signal having a constant period, an A / D converter that converts an analog signal into a digital signal and outputs a speed command, and a speed command are converted. Conversion means for outputting a speed command 1; a rotational position detector for detecting the rotational position of the motor; an actual speed measuring means for counting the rotational position detection signal and outputting an actual speed signal; The control means comprises motor control means for comparing the actual speed signal to control the energization current of the motor. The conversion means includes a memory storing control parameters, an acceleration setting means, and a speed command conversion means, and the memory has a specified speed Sr. and time Ta required to reach, and time Td required to stop the provision of the speed Sr, when the acceleration command is changed at the maximum acceleration and maximum deceleration for each sampling period Ts And a T1, the acceleration setting means obtains the maximum number of steps Qm with Qm = T1 / Ts becomes equation by step number calculating means, DerutaAa jerk instruction DerutaAa in acceleration by the first arithmetic means = Sr / ( Ta × Qm) is obtained by a calculation formula, and a jerk command ΔAd at the time of deceleration is obtained by a second calculation means by a calculation formula of ΔAd = Sr / (Td × Qm), and the current step is taken every sampling period by the speed command conversion means. The number of steps Qk is calculated by adding 0, +1, -1 to the number Q0 under the restriction of Qm, and the arrival speed command at the time when the acceleration command becomes 0 is calculated for each Qk. The step number Qk and the speed command 1 in the next sampling period are determined and output by comparing the arrival speed command and the speed command input, and the jerk during acceleration and deceleration is output. A digital motor control system in which a trapezoid + S-shaped speed command having an S-shaped time width and acceleration as set by independently calculating a command is obtained, and current control based on a smooth speed command is performed. Can be built.
[0007]
According to the second aspect of the present invention, the speed command conversion means is a formula in which Vk = V0 + ΔAa × Qk when accelerating the new speed command Vk with respect to the current speed command V0 for each sampling period, and Vk = The configuration is such that V0 + ΔAd × | Qk | is calculated and output, and the jerk command and the number of steps are converted into a speed command by a relatively simple calculation formula.
[0008]
According to a third aspect of the present invention, the speed command conversion means is an expression of Vd = V0 + ΔAa × Qk × (Qk + 1) / 2 when accelerating the arrival speed command Vd, and Vd = V0 + ΔAd × | Qk | X (| Qk | +1) / 2 is used to calculate the arrival speed when acceleration reaches zero in the shortest time with a simple calculation formula according to different jerk during acceleration and deceleration. It becomes possible to do.
[0009]
【Example】
An embodiment of the present invention will be described below with reference to FIG.
[0010]
FIG. 1 is a block diagram showing an embodiment of the present invention.
[0011]
Reference numeral 1 denotes a volume for setting a speed command, and a speed command voltage of 0 V to Vc is input to the A / D converter 2. Reference numeral 3 denotes a switch for instructing driving / stopping of the motor 4. When the switch is turned on, the speed command voltage is fixed at 0V and the stop is commanded, and when it is turned off, the start is commanded. 5 receives the speed command converted into digital from the A / D converter and converts it into a speed command between the sampling periods Ts in synchronization with the pulsed sampling signal having a constant period Ts from the oscillator 6. A conversion means for outputting a speed command 1 is shown, 7 is a motor control means for controlling the current supplied to the motor 4, and 8 is a pulsed rotational position from a rotational position detector 9 for detecting the rotational position of the motor shaft. The speed measuring means for counting the signal during the sampling period and outputting the actual speed signal of the motor is shown. The conversion means 5, the controller of the motor control means 7 and the speed measuring means 8 are usually controlled by a microcomputer.
[0012]
The operation of the present invention configured as described above will be described below with reference to the time chart of FIG.
[0013]
First, when the switch 3 is turned OFF by the operator, the motor 4 is started toward the speed command input Sm set by the volume 1. The conversion means 5 converts the acceleration command approximated by the trapezoidal acceleration command to the velocity command input Sm, converts it into a velocity command 1 for each sampling period Ts, and outputs it. That is, the acceleration command change value allowed for each sampling period Ts is defined as the jerk of a predetermined unit step, and the maximum acceleration command is defined as the number of steps that is a multiple of the jerk command, so that the acceleration command becomes zero. Processing is performed to calculate the arrival speed command at the time, determine the acceleration command during the next sampling period by comparing the calculation result with the speed command input Sm, and calculate and output the speed command 1 based on this acceleration command. The acceleration command section in which the jerk command of the unit step changes every sampling period is an S-shaped speed command, and the section limited by the maximum acceleration command is a speed command corresponding to the leg of the trapezoidal speed command. It becomes. In this way, the speed command pattern in the acceleration of S-shaped → trapezoid (leg) → S-shaped → trapezoid (Sm) is converted and output as the speed command 1 by the converter 5, and the motor control means 7 outputs the speed command signal. The operation is performed such that an actual speed pattern substantially equal to the speed command 1 is obtained by controlling the current supplied to the motor 4 in accordance with the deviation between 1 and the actual speed signal from the speed measuring means 8. On the other hand, when the switch 1 is turned ON, the speed command input Sm becomes 0 and the acceleration becomes negative, and in the same manner as described above, the deceleration is reduced from S to trapezoid (leg) → S to zero. A speed command pattern is obtained.
[0014]
Here, the conversion means 5 comprises a memory 10, an acceleration setting means 11 and a speed command conversion means 12 as shown in FIG. 3, and FIG. 3 will be described below.
[0015]
The memory 10 is a non-volatile memory that does not lose data even when the power is turned off. As shown in the time chart of FIG. 2 as control parameters, the S-shaped speed command time T1, the acceleration time Ta, and the deceleration Time Td is set by the operator. Here the acceleration time Ta and the deceleration time Td, the control parameter memory 10 as a velocity S r defined instead represented by is usually the speed command input Sm as the time between the stopping and speed command input Sm in Fig. 2 In other words, the acceleration time Ta and the deceleration time Td correspond to control parameters representing acceleration.
[0016]
Next, the operation of the acceleration setting means 11 will be described with reference to the block diagram of FIG.
[0017]
When the smoothness is set as the speed command time T1 of the S-shaped section according to the acceleration / deceleration characteristics of the load by the operator, the maximum number of steps Qm is set to Qm = T1 by the step number calculation means 13 according to the sampling period Ts of the system. Calculated by / Ts and output. Here, the maximum step number Qm is rounded to an integer value as the step number of a quantized jerk command ΔA described later. On the other hand, when the acceleration time Ta until velocity S r defined as one of the control parameters are set, jerk instruction DerutaAa in acceleration by the first jerk calculation unit 14 ΔAa = Sr / (Ta × Qm) is calculated and output. That is, the jerk command ΔAa at the time of acceleration indicates a value at which the acceleration command can change every sampling cycle Ts. Similarly, the second jerk calculating means 15 calculates and outputs the jerk command ΔAd during deceleration by ΔAd = Sr / (Td × Qm).
[0018]
As described above, the maximum step number Qm, the acceleration / deceleration command ΔAa during acceleration, and the acceleration / deceleration command ΔAd during deceleration are determined, and the step number determination means 16 determines the step number Qk in comparison with the speed command input Sm. This point will be described below with reference to FIGS. 5A, 5B, and 6. FIG.
[0019]
FIG. 5 is a time chart showing the conversion process of the speed command conversion means into a speed command. FIG. 5A shows the time of acceleration, FIG. 5B shows the time of deceleration, and FIG. 6 shows a flowchart.
[0020]
In FIG. 5, the acceleration command is expressed in a stepped manner with the quantized jerk command ΔAa as a unit step, and the change for each sampling period Ts is limited by the jerk command ΔAa corresponding to the unit step. It is updated, and the current step number is Q0. Note that the y-axis acceleration command is a value obtained by multiplying the jerk command ΔAa (positive value) during acceleration corresponding to a unit step by the absolute value of the number of steps Q. On the other hand, the speed command is obtained by adding the acceleration command to the current speed command V0 every sampling period Ts. Here, since the change in the acceleration command for each sampling period Ts is limited as the jerk command ΔA in unit steps, the new acceleration step number Qk is Q0 + 1, Q0, Q0-1 when the current acceleration step number Q0 is used as a reference. And the new speed command Vk is
Vk = V0 + ΔAa × Qk (1), and the acceleration command pattern and the speed command pattern until the acceleration command reaches 0 in the shortest time are shown in FIG. Here, the arrival speed command Vd when the acceleration command reaches 0 is obtained by adding the change speed command Vc expressed as an integral value of the acceleration command to the current speed command V0, that is, the new acceleration step number is expressed by Qk. given that,
Vd = V0 + ΔAa × Qk × (Qk + 1) / 2 (2)
[0021]
Substituting into the equation (2) for the three new accelerations described above, the arrival speed command Vd is calculated and compared with the speed command input Vt. When accelerating, the maximum acceleration command pattern is used. One new acceleration command Qk that is closest and satisfies the condition of Vt ≧ Vd is determined. The result of the new acceleration command step number Qk determined in the embodiment of FIG. 5 is Qk = Q0 both during acceleration and deceleration.
[0022]
Here, the operation at the time of deceleration is the same as the operation at the time of acceleration described above. However, the jerk command ΔAd at the time of deceleration is a negative value, the number of steps is calculated as an absolute value, and the acceleration command becomes negative, and the arrival speed The command Vd is calculated by equation (3), and the new speed command Vk is calculated by equation (4).
[0023]
Vd = V0 + ΔAd × | Qk | × (| Qk | +1) / 2 ――― (3)
Vk = V0 + ΔAd × | Qk | ――― (4)
Based on the new acceleration step number Qk determined as described above, the new speed command Vk is calculated by substituting into the equation (1) at the time of acceleration and into the equation (4) at the time of deceleration, and is output as the speed command 1.
[0024]
The above-described operation is described in the flowchart of FIG. 6 separately at the time of acceleration and deceleration. In particular, when the new step number Qk is 0, the speed command is in a constant steady state, but in the control described above, the speed command A quantization error accompanying digitization between the input and the speed command output, that is, a change in speed command below the jerk commands ΔAa and ΔAd cannot be handled. Therefore, in the present invention, as shown in the figure, when the acceleration command is 0 (the number of steps is 0), the speed command input Sm is output as it is, and the speed command error in the steady state is set to 0.
[0025]
【The invention's effect】
As described above, the motor control device of the present invention converts a speed command input into a trapezoid + S-shaped speed command by adding a restriction with a trapezoidal acceleration command in a digital motor control system that performs processing at a sampling cycle of a constant cycle. And a motor control means for controlling the current supplied to the motor in accordance with the deviation from the actual speed. According to the present invention, the present invention can be applied smoothly to a sudden change in the speed command input by a simple configuration and calculation. Current control based on a speed command can be obtained.
[0026]
In addition, according to the present invention, an error associated with quantization of digital control in a steady state can be reduced, and a speed command faithful to the speed command can be obtained.
[0027]
Furthermore, according to the present invention, the jerk command for acceleration and deceleration is calculated independently, so that a trapezoid + S-curve speed command having an S-character width and an acceleration command as set can be obtained. Become.
[Brief description of the drawings]
FIG. 1 is a block diagram of a motor control device according to an embodiment of the present invention. FIG. 2 is a time chart showing the operation of the present invention. FIG. 3 is a block diagram of conversion means. 5A is a time chart showing the operation of the speed command conversion means during acceleration. FIG. 5B is a time chart showing the operation of the speed command conversion means during deceleration. FIG. 6 is a flowchart showing the operation of the speed command conversion means. Explanation of symbols]
DESCRIPTION OF SYMBOLS 1 Volume 2 A / D converter 3 Switch 4 Motor 5 Conversion means 6 Oscillator 7 Motor control means 8 Speed measurement means 9 Rotation position detector 10 Memory 11 Acceleration setting means 12 Speed command conversion means

Claims

An oscillator that outputs a sampling signal having a fixed period; an A / D converter that converts an analog signal into a digital signal and outputs a speed command; and a converter that converts the speed command and outputs a speed command 1; A rotational position detector for detecting the rotational position of the motor; an actual speed measuring means for counting the rotational position detection signal and outputting an actual speed signal; and comparing the speed command 1 with the actual speed signal to determine the motor energization current. Motor control means for controlling, the conversion means includes a memory storing control parameters, an acceleration setting means, and a speed command conversion means, and the memory takes a time Ta required to reach a specified speed Sr, and a specified speed A time Td required to stop from Sr, and a time T1 during which the acceleration command changes at maximum acceleration and maximum deceleration for each sampling period Ts. Is determined by Qm = T1 / Ts becomes equation the maximum number of steps Qm by step number calculating means calculates at ΔAa = Sr / (Ta × Qm ) becomes equation jerk instruction DerutaAa in acceleration by the first arithmetic means Then, the jerk command ΔAd at the time of deceleration is obtained by the calculation formula ΔAd = Sr / (Td × Qm) by the second computing means, and the current command number Q0 is limited to the current step number Q0 for each sampling period by the speed command converting means. And 0, +1, -1 are added to calculate the number of steps Qk, and for each Qk, the arrival speed command when the acceleration command becomes 0 is calculated, the arrival speed command and the speed command input, The motor control device that determines and outputs the step number Qk and the speed command 1 in the next sampling period by comparing the two.

The speed command conversion means calculates and outputs a new speed command Vk with an expression of Vk = V0 + ΔAa × Qk at the time of acceleration and an expression of Vk = V0 + ΔAd × | Qk | The motor control apparatus according to claim 1 , which is configured as described above.

The speed command conversion means uses the formula Vd = V0 + ΔAa × Qk × (Qk + 1) / 2 when accelerating the arrival speed command Vd, and Vd = V0 + ΔAd × | Qk | × (| Qk | +1) / 2 when decelerating. the motor control device according to claim 1, wherein the seek.