JP2012182933A - Motor controller - Google Patents
Motor controller Download PDFInfo
- Publication number
- JP2012182933A JP2012182933A JP2011045055A JP2011045055A JP2012182933A JP 2012182933 A JP2012182933 A JP 2012182933A JP 2011045055 A JP2011045055 A JP 2011045055A JP 2011045055 A JP2011045055 A JP 2011045055A JP 2012182933 A JP2012182933 A JP 2012182933A
- Authority
- JP
- Japan
- Prior art keywords
- model
- motor
- vibration
- torque
- speed
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000013178 mathematical model Methods 0.000 claims abstract description 59
- 238000004364 calculation method Methods 0.000 claims description 34
- 230000004069 differentiation Effects 0.000 claims description 13
- 238000012546 transfer Methods 0.000 claims description 11
- 230000004044 response Effects 0.000 claims description 7
- 230000008859 change Effects 0.000 abstract description 54
- 230000001629 suppression Effects 0.000 abstract description 45
- 230000015572 biosynthetic process Effects 0.000 abstract 1
- 238000013016 damping Methods 0.000 description 76
- 230000014509 gene expression Effects 0.000 description 29
- 238000010586 diagram Methods 0.000 description 23
- 238000001514 detection method Methods 0.000 description 15
- 230000006870 function Effects 0.000 description 11
- 238000012937 correction Methods 0.000 description 6
- 230000002123 temporal effect Effects 0.000 description 5
- 238000013139 quantization Methods 0.000 description 4
- 230000006399 behavior Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000000034 method Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 238000012935 Averaging Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000001771 impaired effect Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Images
Abstract
Description
本発明は、モータ制御装置に関する。 The present invention relates to a motor control device.
剛性の低い産業用機械装置において、モータにより産業用機械装置の位置決め駆動が行われると、機械共振などに起因して停止時に残留振動が発生する場合がある。このような残留振動を抑制するために、モータを介して産業用機械装置を動作させるモータ制御装置は、動作目標値に応じて産業用機械装置の振動周波数(共振周波数)の信号成分が小さくなるように制御信号を演算し、産業用機械装置の制振制御を行う。モータ制御装置がこの制振制御を行うためには、産業用機械装置を含む制御系の振動周波数に応じた制振制御の制振パラメータが必要である。動作中に振動周波数が変化しない産業用機械装置に対しては、固定の制振パラメータをモータ制御装置に設定すれば、十分残留振動が抑制可能である。 In an industrial machine device with low rigidity, when the industrial machine device is positioned and driven by a motor, residual vibration may occur during stoppage due to mechanical resonance or the like. In order to suppress such residual vibration, a motor control device that operates an industrial machine device via a motor has a signal component of a vibration frequency (resonance frequency) of the industrial machine device that is reduced according to an operation target value. As described above, the control signal is calculated to control the vibration of the industrial machine. In order for the motor control device to perform the vibration suppression control, a vibration suppression parameter for the vibration suppression control according to the vibration frequency of the control system including the industrial machine device is necessary. For industrial machinery whose vibration frequency does not change during operation, residual vibration can be sufficiently suppressed by setting a fixed damping parameter in the motor controller.
一方、産業用機械装置の中には、直行ロボット、クレーンなどのように動作中に振動周波数が変化するものが存在する。このような産業用機械装置に対しては、固定の制振パラメータをモータ制御装置に設定しても、残留振動を抑制できない傾向にある。 On the other hand, some industrial mechanical devices, such as a direct robot and a crane, change the vibration frequency during operation. For such industrial machinery, there is a tendency that residual vibration cannot be suppressed even if a fixed damping parameter is set in the motor controller.
それに対して、特許文献1には、x軸用のモータによりアームをx軸方向に移動させるとともにz軸用のモータによりアーム先端の重量物をz軸方向に移動させることが可能な機械制御装置において、アーム及び重量物を含む制御対象の変化する振動周波数に応じて、パラメータ(ゲイン定数)を変更することが記載されている。具体的には、制御用データテーブルがスライド部からアーム先端の重量物までの距離についての位置情報を得て振動周波数の補正量に係る出力データを出力し、補正ブロックが制御用データテーブルの出力データから得られたパラメータ(ゲイン定数)を位置指令値の2階微分値に乗算して補正量を求めて加算器へ出力し、加算器がこの補正量を元の位置指令に加算する。これにより、特許文献1によれば、制御対象における移動する一部の構成部材の現在位置に応じた振動周波数等の変化を考慮して補正を行うので、所定位置まで移動させた制御対象を振動させずに停止させることができるとされている。
On the other hand,
また、特許文献2には、機械の位置制御装置において、機械を電動機と機械端とからなる2慣性共振系として模擬して電動機と機械端との理論速度偏差を求め、その理論速度偏差から補償トルクを演算し、位置指令に応じたトルク成分から補償トルクを減算して理論トルクを求め、理論トルクを用いて実位置及び実速度がそれぞれ理論位置及び理論速度に追従するようにトルク指令を制御することが記載されている。そして、機械のX軸駆動を行う際に、他軸位置であるY軸位置に応じて機械端慣性、補償トルク比例係数、補償トルク積分係数を逐次変更し、機械端速度を演算する際に用いる負荷慣性を変更後の機械端慣性で書き換え、補償トルクを演算する際に用いる比例係数及び積分係数を変更後の補償トルク比例係数及び補償トルク積分係数で書き換えるとされている。これにより、特許文献2によれば、Y軸位置の移動により機械系の特性が変化した場合でも、機械系の特性に合った最適な制御を得ることができるので、振動抑制性能が損なわれることなく高精度な位置制御を達成できるとされている。
In
特許文献1に記載された機械制御装置では、変化する機械の振動周波数に対応させながらパラメータ(ゲイン定数)を変化させて位置指令値の2階微分値に乗算することで、動作中に機械固有振動数が変化する制御対象に対しても振動を励起しないようにした指令生成法が実現されている。しかしながら、パラメータを変化する機械固有振動数に正確に対応させながら変化させるだけでは補正の精度が低く、振動抑制制御の精度が低い傾向にある。
In the machine control device described in
特許文献2に記載された位置制御装置では、機械系の変化に合わせて、2慣性共振系モデルにおける負荷慣性とねじり位置制御の比例ゲイン・積分ゲインとを可変にしている。このように変更するゲインがねじり位置制御のゲインのみであるため、機械系の特性の変化に合わせて、位置指令から理論位置・理論速度・理論トルクまでの特性が変化してしまい、振動抑制制御における追従特性の指定が難しい。追従特性を指定できない場合、振動抑制制御の精度を向上することが困難になる。
In the position control device described in
本発明は、上記に鑑みてなされたものであって、動作中に振動特性が変化する制御対象に対する振動抑制制御の精度を向上できるモータ制御装置を得ることを目的とする。 The present invention has been made in view of the above, and an object of the present invention is to obtain a motor control device capable of improving the accuracy of vibration suppression control for a controlled object whose vibration characteristics change during operation.
上述した課題を解決し、目的を達成するために、本発明の1つの側面にかかるモータ制御装置は、モータ及び振動可能要素を有する制御対象の動作を制御するモータ制御装置であって、前記制御対象の動作を動作目標値に追従させるようにモデルトルクを生成する制御部と、前記モデルトルクに応じて前記モータに対するトルク指令を発生させる発生部とを備え、前記制御部は、前記制御対象の振動関連情報に応じて、前記制御対象の振動特性を表す振動パラメータを生成する生成部と、前記振動パラメータに応じて、前記制御対象の動特性を模擬した数式モデルを変更し、前記モデルトルクから前記変更された数式モデルにより、前記制御対象の動作状態を含むモデル変数を演算する第1の演算部と、前記モデル変数が一定の追従特性で前記動作目標値に追従するように、前記モデルパラメータと前記動作目標値から前記振動パラメータに応じて特性を変化させた演算により前記モデルトルクを演算する第2の演算部とを有することを特徴とする。 In order to solve the above-described problems and achieve the object, a motor control device according to one aspect of the present invention is a motor control device that controls an operation of a control target having a motor and a vibratable element, and the control A control unit that generates a model torque so that the target operation follows the target operation value; and a generation unit that generates a torque command for the motor in accordance with the model torque. According to vibration related information, a generator that generates a vibration parameter that represents the vibration characteristic of the control object, and a mathematical model that simulates the dynamic characteristic of the control object is changed according to the vibration parameter, and from the model torque A first computing unit that computes a model variable including the operation state of the controlled object by the modified mathematical model, A second calculating unit that calculates the model torque by calculating the characteristics of the model parameter and the operation target value according to the vibration parameter so as to follow the operation target value. .
本発明によれば、動作中に振動周波数が変化する制御対象に対して、動作目標値に対するモデルパラメータの追従特性が一定の特性になるように指定することができるので、容易に振動抑制制御の精度を向上できる。すなわち、動作中に振動特性が変化する制御対象に対する振動抑制制御の精度を向上できる。 According to the present invention, it is possible to specify that the tracking characteristic of the model parameter with respect to the operation target value is a constant characteristic for a control target whose vibration frequency changes during operation. Accuracy can be improved. That is, it is possible to improve the accuracy of vibration suppression control for a control object whose vibration characteristics change during operation.
以下に、本発明にかかるモータ制御装置の実施の形態を図面に基づいて詳細に説明する。なお、この実施の形態によりこの発明が限定されるものではない。 Embodiments of a motor control device according to the present invention will be described below in detail with reference to the drawings. Note that the present invention is not limited to the embodiments.
実施の形態1.
実施の形態1にかかるモータ制御装置100の構成について図1を用いて説明する。図1は、実施の形態1にかかるモータ制御装置100の構成を示すブロック図である。
The configuration of the
モータ制御装置100は、駆動する制御対象1の位置目標値(動作目標値、位置指令)yrefを外部(例えば、図示しない上位コントローラ)から受けるとともに、検出器2(例えば、エンコーダ)により検出されたモータ1aの位置(例えば、モータ1a内におけるロータの回転位置又は可動子の駆動位置)を表すモータ位置検出値pMを検出器2から受ける。また、モータ制御装置100は、制御対象1の振動特性に関連した制御対象1の状態を表すパラメータ変更信号(振動関連情報)MLを検出器3から受ける。振動関連情報とは、例えば振動可能要素のバネ定数のように制御対象1を駆動した際に発生する振動の振動周波数に影響を与える値を示す。モータ制御装置100は、パラメータ変更信号MLに応じた動作を行うとともに、モータ位置検出値pMが位置目標値yrefへ追従するようにトルク指令τMを発生させて電流制御器4へ出力する。これにより、電流制御器4がトルク指令τMに応じた電流I(に依存した電力)を制御対象1内部にあるモータ1aへ供給するので、モータ1aは、トルク指令τMに応じたモータトルクを発生して制御対象1内部にあるバネなどの弾性体もしくは柔軟物(振動可能要素)1b及び機械負荷1cを動作させる。
The
具体的には、モータ制御装置100は、フィードフォワード制御部111、フィードバック制御部112、及びトルク加算器113を備える。フィードバック制御部112及びトルク加算器113はトルク指令τMを発生させる発生部として機能する。
Specifically, the
フィードフォワード制御部111は、位置目標値yrefを外部から受けるとともに、パラメータ変更信号MLを検出器3から受ける。検出器3は、例えば、アーム長検出器であり、z軸アーム1b1(図3参照)の長さをパラメータ変更信号(振動関連情報)MLとして検出する。あるいは、検出器3は、例えば、ロープ長検出器であり、ロープ1b2(図4参照)の長さをパラメータ変更信号(振動関連情報)MLとして検出する。フィードフォワード制御部111は、制御対象1の理想的な動作波形に対応したモデル位置pa、モデル速度vaをフィードバック制御部112へ出力し、モデルトルクτaをトルク加算器113へ出力する。
The
フィードバック制御部112は、フィードフォワード制御部111から出力されたモデル位置pa、モデル速度vaを受けるとともに、検出器2からフィードバックされた制御対象1(モータ1a)のモータ位置検出値pMを受けて、トルク加算器113へフィードバックトルクτBを出力する。
トルク加算器113は、フィードバックトルクτBとモデルトルクτaとの和をトルク指令τMとして発生させて電流制御器4へ出力する。電流制御器4は、トルク加算器113から出力されたトルク指令τMを受けて、トルク指令τMと一致するモータトルクを実現する実電流I(に依存した電力)をモータ1aへ加える(供給する)。そして電流制御器4から出力された実電流Iをモータ1aに流すことにより、制御対象1内のバネなどの弾性体もしくは柔軟物(振動可能要素)1b及び機械負荷1cが駆動される。また、検出器2により、制御対象1内のモータ1aのモータ位置検出値pMが検出される。
The
次に、フィードフォワード制御部111の内部構成の概略について説明する。フィードフォワード制御部111は、制振パラメータ決定部(生成部)123、制振パラメータフィルタ(第2の生成部)124、数式モデル(第1の演算部)121、及びモデル制御器(第2の演算部)122を有する。
Next, an outline of the internal configuration of the
制振パラメータ決定部123は、パラメータ変更信号MLを受けて制振パラメータ信号θを生成する。すなわち、制振パラメータ決定部123は、パラメータ変更信号MLに基づき、制御対象1の現在の振動特性(例えば、共振周波数)を表す制振パラメータ信号(振動パラメータ)θを生成して制振パラメータフィルタ124、モデル制御器122、及び数式モデル121へ出力する。
The damping
制振パラメータフィルタ124は、制振パラメータ信号θからその時間変化量に応じた制振パラメータ変分信号θ’を生成する。すなわち、制振パラメータフィルタ124は、制振パラメータ信号θを受けて、制御対象1の振動特性変化を表す、すなわち制振パラメータ信号θの時間変化率に相当する制振パラメータ変分信号(第2の振動パラメータ)θ’を演算して、演算した結果をモデル制御器122及び数式モデル121へ出力する。
The vibration
数式モデル121は、制御対象1の動特性を模擬した数式モデルを用いてモデル出力を演算する。すなわち、数式モデル121は、制振パラメータ信号θを制振パラメータ決定部123から受け、制振パラメータ変分信号θ’を制振パラメータフィルタ124から受け、モデルトルクτaをモデル制御器122から受ける。数式モデル121は、制御対象1の動特性を模擬した数式モデルを有しており(例えば、図2(b)参照)、制振パラメータ信号θ及び制振パラメータ変分信号θ’に応じて数式モデルを変更する。数式モデル121は、モデルトルクτaから、変更後の数式モデルにより、モデル位置pa、モデル速度va、内部変数xa、モデル出力(モデル変数)yaを演算する。そして、数式モデル121は、モデル位置pa及びモデル速度vaをモデル制御器122及びフィードバック制御部112へ供給し、内部変数xa及びモデル出力yaをモデル制御器122へ供給する。ここで、内部状態xaは、例えばn次(nは1以上)の数値ベクトルである。また、モデル出力yaは、制御対象1の動特性を模擬した数式モデルにおいて、動作目標値に追従させたい信号を表す。例えば、動作目標値が位置指令の場合は、モデル出力もモータ回転位置、機械位置など位置情報に関する信号、動作目標値が速度指令の場合は、モデル出力もモータ回転速度、機械速度など速度情報に関する信号を表す。
The
モデル制御器122は、最終的にはモデル出力yaとモデル位置paとを位置目標値yrefに追従させる。すなわち、モデル制御器122は、位置目標値yrefを外部から受け、制振パラメータ信号θを制振パラメータ決定部123から受け、制振パラメータ変分信号θ’を制振パラメータフィルタ124から受け、モデル位置pa、モデル速度va、内部状態xa、モデル出力yaを数式モデル121から受ける。モデル制御器122は、これらの入力の値を用いた状態フィードバックを行う。すなわち、モデル制御器122は、数式モデル121の各出力と、制振パラメータ信号θ及び制振パラメータ変分信号θ’に応じて変化するゲインとの乗算に基づき、数式モデル121のモデル位置paが制御対象1に振動を励起させず、かつ定常的にはモデル出力ya及びモデル位置paが位置目標値yrefに一致するように、モデルトルクτaを計算して出力する。
次にフィードバック制御部112の内部構成について説明する。フィードバック制御部112は、位置制御器132、速度演算器133、及び速度制御器131を有する。
Next, the internal configuration of the
位置制御器132は、フィードフォワード制御部111から出力されたモデル位置paを受けるとともに、検出器2からフィードバックされたモータ位置検出値pMを受ける。位置制御器132は、モータ位置検出値pMがモデル位置paに追従するように速度指令vuを計算する。位置制御器132は、計算した速度指令vuを速度制御器131へ出力する。例えば、位置制御器132が比例制御の場合、位置比例ゲインをKpとして、式(1)の演算を行い、その結果を速度指令vuとして出力する。
vu=Kp(pa−pM)・・・(1) v u = K p (p a -p M) ··· (1)
速度演算器133は、検出器2より検出されたモータ位置検出値pMを受ける。速度演算器133は、受けたモータ位置検出値pMに対して差分やフィルタ処理等を行い、モータ速度演算値vMを計算する。速度演算器133は、計算したモータ速度演算値vMを速度制御器131へ出力する。
The
速度制御器131は、フィードフォワード制御部111から出力されたモデル速度vaを受け、位置制御器132から出力された速度指令vuを受け、速度演算器133から出力されたモータ速度演算値vMを受ける。速度制御器131は、モータ速度演算値vMをモデル速度vaに追従させるように、すなわちモータ速度演算値vMがモデル速度vaと速度指令vuとの和に一致するように速度PI制御などの演算によりフィードバックトルクτBを計算する。速度制御器131は、計算したフィードバックトルクτBをトルク加算器113へ出力する。速度制御器131における計算処理の例として、式(2)のようにPI制御とフィルタとの組み合わせがある。ここでsはラプラス演算子、Kvは速度比例ゲイン、Kiは速度積分ゲインである。フィルタH(s)は速度制御器131の速度比例ゲイン、速度積分ゲインで決まる制御帯域よりも高い周波数において所定の周波数成分を除去するもので、ローパスフィルタやノッチフィルタと呼ばれるものを用いる。
τB=H(s)×Kv×((s+Ki)/s)×(vu+va−vM)
・・・(2)
τ B = H (s) × K v × ((s + K i) / s) × (v u + v a -v M)
... (2)
これに応じて、トルク加算器113は、フィードバック制御部112で計算されたフィードバックトルクτBとフィードフォワード制御部111で計算されたモデルトルクτaを加算し、トルク指令τMを計算する。そして、トルク加算器113は、電流制御器4にトルク指令τMを出力する。これにより、制御対象1にあるモータ1aを駆動し、モータ位置検出値pMを位置目標値yrefに追従させ、制御対象1に所望の動作を行わせることになる。
In response to this, the
次に、フィードフォワード制御部111の動作について詳細に説明する。本実施の形態では、数式モデル121を、図2(a)に示すようにモータがバネを介して機械負荷を起動する2慣性系モデルで表すこととして説明する。また、本実施の形態では、バネのバネ係数が動作中に変化するとする。図2(a)に示す2慣性系モデルの運動方程式は、式(3)、(4)で表すことができる。
Next, the operation of the
JM×v(1) aM=−km×(paM−paL)+τaM・・・(3) J M × v (1) aM = -k m × (p aM -p aL) + τ aM ··· (3)
JL×v(1) aL=km×(paM−paL)・・・(4)
式(3)、(4)において、paMはモータ位置(例えば、モータ1a内におけるロータの回転位置又は可動子の駆動位置)、vaMはモータ速度(例えば、モータ1a内におけるロータの回転速度又は可動子の駆動速度)、paLは機械位置(機械負荷1cの位置)、vaLは機械速度(機械負荷1cの移動速度)、JMはモータ1aの慣性モーメント、JLは機械負荷1cの慣性モーメント、τaMはモータトルク(例えば、モータ1a内におけるロータ又は可動子に作用するトルク)、kmはバネ定数を表す。このとき、式(5)、(6)に示す関係が成り立つ。
J L × v (1) aL = k m × (p aM -p aL) ··· (4)
In equations (3) and (4), paM is the motor position (for example, the rotational position of the rotor in the
vaM=p(1) aM・・・(5) v aM = p (1) aM (5)
vaL=p(1) aL・・・(6)
式(5)、(6)において、p(1) aLはpaLの時間に関する1階微分を表している。以後各記号の右上にある()内の数値は時間に関する微分の回数を表す。図2(b)には、図2(a)に示す2慣性系モデルに対応した数式モデル121の内部構成をブロック線図で示している。図2における記号の図1における記号との対応関係を説明すると、モータ位置paMがモデル位置pa、モータ速度vaMがモデル速度va、モータトルクτaMがモデルトルクτa、機械位置paLがモデル出力ya、機械速度vaLが内部変数xaに相当する。また、本実施の形態では、km(バネ定数)は固定値ではなく動作中に変化し、それに応じて式(7)、(8)で表される2慣性系モデルの共振周波数ωp、反共振周波数ωzも動作中に変化する。
v aL = p (1) aL (6)
In Expressions (5) and (6), p (1) aL represents the first-order derivative with respect to time of paL . Thereafter, the numerical value in () at the upper right of each symbol represents the number of differentiations with respect to time. FIG. 2B shows a block diagram of the internal configuration of the
ωp=√(km×(1/JL+1/JM))・・・(7) ω p = √ (k m × (1 / J L + 1 / J M)) ··· (7)
ωz=√(km/JL)・・・(8)
なお、式(7)、(8)を用いて式(3)、(4)を書き直すと、次のようになる。
ω z = √ (k m / J L) ··· (8)
Note that rewriting equations (3) and (4) using equations (7) and (8) yields the following.
v(1) aM=−JL/(JL+JM)×ωp 2×(paM−paL)
+1/JM×τaM・・・(9)
v (1) aM = -J L / (J L + J M) × ω
+ 1 / J M × τ aM (9)
v(1) aL=ωz 2×(paM−paL)・・・(10) v (1) aL = ω z 2 × (p aM -p aL) ··· (10)
つまり、数式モデル121は、後述する非線形補償器142からモータトルクτaMを受け、制振パラメータ決定部123から制振パラメータ信号θに相当する共振周波数ωp及び反共振周波数ωzを受ける。そして、数式モデル121は、式(5)、(6)、(9)、(10)を用いて、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを計算する。数式モデル121は、モータ位置paM及びモータ速度vaをモデル制御器122及びフィードバック制御部112へ供給し、機械位置paL及び機械速度vaLをモデル制御器122へ供給する。
That is, the
このようなバネ定数kmが動作中に変化する2慣性系でモデル化ができる機械装置としては、例えば、図3(a)に示すようなz軸アーム1b1のアーム長が変化する直交2軸(x−y)ロボットや、図4に示すようなロープ1b2のロープ長が変化するクレーンなどが挙げられる。 Two orthogonal axes such spring constant k m is a mechanical device modeling can be a two-inertia system that changes during operation, for example, the arm length of the z-axis arm 1b1 as shown in FIG. 3 (a) is changed (Xy) A robot, a crane in which the rope length of the rope 1b2 as shown in FIG.
図3(a)に示す直交2軸(x−y)ロボットでは、x軸モータ1a1及びz軸モータ1a11によりそれぞれ2つのアームすなわちx軸アーム1d1及びz軸アーム1b1が駆動される。x軸アーム1d1をx軸方向に駆動させると、z軸アーム1b1全体がx軸方向へ移動する。また、z軸アーム1b1を駆動させるとz軸方向に負荷1c1が移動する構成になっている。このような直交2軸ロボットでは、x軸方向に負荷1c1を高速駆動させると振動が発生する。その振動特性を表したのが図3(b)、(c)のボード線図である。図3(b)、(c)のボード線図を見ると、z軸アーム1b1が短い場合と長い場合の両方において、ゲイン特性が山になっている共振特性と、ゲイン特性が谷になっている反共振特性とがあることがわかる。このような共振・反共振周波数の存在する機械の動特性は式(3)、(4)で表される2慣性系モデルを用いて表されることは既に良く知られている。なお、図3(b)、(c)のボード線図では、z軸アーム1b1の長さが短い場合のx軸方向のゲイン特性が破線で示され、z軸アーム1b1の長さが長い場合のx軸方向のゲイン特性が実線で示されている。 In the orthogonal two-axis (xy) robot shown in FIG. 3A, two arms, that is, an x-axis arm 1d1 and a z-axis arm 1b1, are driven by an x-axis motor 1a1 and a z-axis motor 1a11, respectively. When the x-axis arm 1d1 is driven in the x-axis direction, the entire z-axis arm 1b1 moves in the x-axis direction. Further, when the z-axis arm 1b1 is driven, the load 1c1 moves in the z-axis direction. In such an orthogonal two-axis robot, vibration is generated when the load 1c1 is driven at high speed in the x-axis direction. The vibration characteristics are shown in the Bode diagrams of FIGS. 3 (b) and 3 (c). 3B and 3C, when the z-axis arm 1b1 is short and long, the resonance characteristic having a peak gain characteristic and the gain characteristic having a trough are obtained. It can be seen that there are anti-resonance characteristics. It is already well known that the dynamic characteristics of a machine having such resonance and antiresonance frequencies are expressed using a two-inertia system model expressed by equations (3) and (4). In the Bode diagrams of FIGS. 3B and 3C, the gain characteristic in the x-axis direction when the length of the z-axis arm 1b1 is short is indicated by a broken line, and the length of the z-axis arm 1b1 is long. The gain characteristic in the x-axis direction is indicated by a solid line.
また、直交2軸ロボットの場合、図3(b)、(c)のボード線図に示されるように、負荷1c1をx軸方向に駆動させたときの振動周波数が、z軸方向のアーム長に依存する。図3(b)、(c)に示すような特性の場合、z軸アーム1b1のアーム長が長い場合は、x軸方向に駆動させたときの負荷1c1による振動周波数が低く、z軸アーム1b1のアーム長が短い場合は、x軸方向に駆動させたときの負荷1c1による振動周波数が高い。つまり、x軸アーム1d1及びz軸アーム1b1の両方を同時に駆動させた場合、負荷1c1による振動特性(共振、反共振特性)は時間により変化する。このように共振、反共振特性が時間により変化する場合、直交2軸ロボットの特性を、式(3)、(4)で表されるバネ定数kmが時間変化する2慣性系モデルを用いて表すことが可能である。 In the case of an orthogonal two-axis robot, as shown in the board diagrams of FIGS. 3B and 3C, the vibration frequency when the load 1c1 is driven in the x-axis direction is the arm length in the z-axis direction. Depends on. 3B and 3C, when the arm length of the z-axis arm 1b1 is long, the vibration frequency due to the load 1c1 when driven in the x-axis direction is low, and the z-axis arm 1b1 When the arm length is short, the vibration frequency due to the load 1c1 when driven in the x-axis direction is high. That is, when both the x-axis arm 1d1 and the z-axis arm 1b1 are driven simultaneously, the vibration characteristics (resonance and anti-resonance characteristics) due to the load 1c1 change with time. Thus resonance, if the anti-resonance characteristics change with time, the properties of the orthogonal two-axis robot, the formula (3), using a two-inertia system model spring constant k m is changed time represented by (4) Can be represented.
図4で表されるロープ長が変化するクレーンの場合は、モータ1a2によりスライダ1d2を駆動させることでロープ1b2を介して負荷1c2が水平方向に移動し、ロープ1b2の巻き上げ、巻き下げにより負荷1c2が垂直方向に移動する。この場合、スライダ1d2による水平方向の駆動が上記の直交2軸ロボットにおけるx軸アーム1d1の駆動に対応し、ロープ1b2の巻き上げ及び巻き下げがz軸アーム1b1の駆動に対応する。すなわち、ロープ1b2の長さにより、スライダ1d2を駆動させたときの負荷1c2の振動周波数が異なる。このようにロープ1b2の長さにより振動周波数が異なるが、この場合も、式(3)、(4)で表されるバネ定数kmが時間変化する2慣性系モデルで表すことが可能である。 In the case of a crane whose rope length is changed as shown in FIG. 4, the load 1c2 is moved in the horizontal direction via the rope 1b2 by driving the slider 1d2 by the motor 1a2, and the load 1c2 is lifted and lowered by the rope 1b2. Moves vertically. In this case, the horizontal drive by the slider 1d2 corresponds to the drive of the x-axis arm 1d1 in the orthogonal biaxial robot, and the winding and unwinding of the rope 1b2 corresponds to the driving of the z-axis arm 1b1. That is, the vibration frequency of the load 1c2 when the slider 1d2 is driven varies depending on the length of the rope 1b2. Although this way the vibration frequency varies by the length of the rope 1b2, also in this case, equation (3) can be represented by the two-inertia system model changes the spring constant k m is the time represented by (4) .
なお、ここで説明したものは数式モデル121の一例であり、数式モデル121の運動方程式又は動特性が式(3)、(4)または(5)、(6)、(9)、(10)に限定されるものではない。
In addition, what was demonstrated here is an example of the
次に、本実施の形態におけるモデル制御器122について図5を用いて詳細に説明する。図5は、モデル制御器122の構成及び動作を表すブロック線図である。
Next, the
モデル制御器122は、状態フィードバック制御器(第3の演算部)141及び非線形補償器(補償部)142を有する。状態フィードバック制御器141は、位置目標値yref、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを受けて、仮想入力uaMを生成して非線形補償器142へ供給する。非線形補償器142は、仮想入力uaM、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを受けて、モータトルクτaMを演算して出力する。次にこれらの動作について詳細に説明する。
The
非線形補償器142は、仮想入力uaM、モータ位置paM、モータ速度vaM、機械位置paL、及び機械速度vaLを受けて、数式モデル121に存在する非線形特性を補償し、仮想入力uaMから機械位置paLまでの伝達特性が線形特性となるように下記の式(11)を用いて、モータトルクτaMを演算する。ここで図示していないが、共振周波数ωp、反共振周波数ωzは、制振パラメータ決定部123から入力させる制振パラメータθに相当し、共振周波数ωp、反共振周波数ωzの1階微分ω(1) p、ω(1) zと2階微分ω(2) p、ω(2) zとは、制振パラメータフィルタ124から入力される制振パラメータ変分信号θ’に相当する。
The
τaM=JM/ωz 2×uaM
+JM×{ωp 2−2×ω(2) p/ωp−2×(ω(1) p/ωp)2}
×(paM−paL)
−4×JM×(ω(1) p/ωp)×(vaM−vaL)・・・(11)
τ aM = J M / ω z 2 × u aM
+ J M × {ω p 2 −2 × ω (2) p / ω p −2 × (ω (1) p / ω p ) 2 }
X ( paM- paL )
-4 × J M × (ω ( 1) p / ω p) × (v aM -v aL) ··· (11)
状態フィードバック制御器141は、位置目標値yref及び機械位置paLを受けて、フィードフォワード制御部111が所定の特性となるように仮想入力uaMを計算し、非線形補償器142へ出力する。本実施の形態においては、状態フィードバック制御器141が、下記の式(12)に示される状態フィードバック制御則を用いて仮想入力uaMを計算する。そして、状態フィードバック制御器141は、計算した仮想入力uaMを非線形補償器142へ供給する。式(12)において、K1、K2、K3、K4は状態フィードバックゲインであり、状態フィードバック制御器141は、これらの値を調整することによりフィードフォワード制御部111の追従特性を決定する。
The
uaM=K1×K2×K3×K4×(yref−paL)
−K2×K3×K4×p(1) aL
−K3×K4×p(2) aL
−K4×p(3) aL・・・(12)
u aM = K 1 × K 2 × K 3 × K 4 × (y ref −pa L )
-K 2 × K 3 × K 4 × p (1) aL
−K 3 × K 4 × p (2) aL
−K 4 × p (3) aL (12)
上記の説明に基づき、フィードフォワード制御部111全体の動作を説明すると以下の通りになる。
Based on the above description, the overall operation of the
状態フィードバック制御器141は、位置目標値yrefと、機械位置paLの現在値(初期値)とを受けて、仮想入力uaMを式(12)により計算する。そして計算した仮想入力uaMを非線形補償器142へ供給する。
The
非線形補償器142は、機械位置paL、機械速度vaL、モータ位置paM、モータ速度vaM、及び状態フィードバック制御器141で計算された仮想入力uaMを受けて、式(11)を用いてモータトルクτaMを計算する。このとき、共振周波数ωp、反共振周波数ωzとそれらの微分ω(1) p、ω(1) z、ω(2) p、ω(2) zは、それぞれ制振パラメータ決定部123、制振パラメータフィルタ124から出力された値を用いる。これらの値が可変パラメータとなる。そして、非線形補償器142は、計算したモータトルクτaMを数式モデル121へ出力する。
The
数式モデル121は、非線形補償器142で計算されたモータトルクτaMと制振パラメータ決定部123から出力された共振周波数ωp、反共振周波数ωzを受けて、2慣性系モデルの運動方程式(5)、(6)、(9)、(10)に基づき、機械位置paL、機械速度vaL、モータ位置paM、モータ速度vaMを計算する(例えば、図2(b)参照)。このとき、共振周波数ωp、反共振周波数ωzが可変パラメータとなる。数式モデル121は、モータ位置paM、モータ速度vaMをフィードバック制御部112へ供給し、機械位置paLを状態フィードバック制御器141へ供給し、機械位置paL、機械速度vaL、モータ位置paM、モータ速度vaMを非線形補償器142へ供給する(図1、図5参照)。
The
次に、フィードフォワード制御部111の特性について説明する。
Next, the characteristics of the
式(5)、(6)、(9)、(10)で表される2慣性系モデルにおいて、式(10)の2階微分に基づきモータトルクτaMから機械位置paLまでの特性を計算すると
p(4) aL=ωz 2/JM
×[JM×{−ωp 2+2×ω(2) p/ωp+2×(ω(1) p/ωp)2}
×(paM−paL)
+4×JM×(ω(2) p/ωp)×(vaM−vaL)
+τaM]・・・(13)
となる。つまり、共振周波数ωp、反共振周波数ωzが変化する2慣性系モデルでは、その動特性が共振周波数ωp、反共振周波数ωzだけでなく、それらの時間的な変化率ω(1) p、ω(1) z、ω(2) p、ω(2) zにも影響される。
In the two-inertia system model expressed by the equations (5), (6), (9), and (10), the characteristics from the motor torque τ aM to the machine position paL are calculated based on the second-order derivative of the equation (10). Then p (4) aL = ω z 2 / J M
× [J M × {−ω p 2 + 2 × ω (2) p / ω p + 2 × (ω (1) p / ω p ) 2 }
X ( paM- paL )
+ 4 × J M × (ω (2) p / ω p) × (v aM -v aL)
+ Τ aM ] (13)
It becomes. That is, in the two-inertia system model in which the resonance frequency ω p and the anti-resonance frequency ω z change, the dynamic characteristic is not only the resonance frequency ω p and the anti-resonance frequency ω z, but also their temporal change rate ω (1). p , ω (1) z , ω (2) p , ω (2) z are also affected.
非線形補償器142は、この共振周波数ωp、反共振周波数ωzの時間的な変化率ω(1) p、ω(1) z、ω(2) p、ω(2) zに起因する非線形特性を補償する。実際に式(11)を式(13)に代入すると
The
p(4) aL=uaM・・・(14)
となり、機械位置paLがモデル出力yaに対応していることから仮想入力uaMからモデル出力yaまでの伝達特性が4重積分の線形特性となる。つまり、非線形補償器142の入力である仮想入力uaMからモデル出力yaである機械位置paLまでの伝達特性には、共振周波数ωp、反共振周波数ωzの時間的な変化率ω(1) p、ω(1) z、ω(2) p、ω(2) zが全く影響を与えない。
p (4) aL = u aM (14)
Next, machine position p aL is transfer characteristics from the virtual input u aM from Be for the model output y a to the model output y a is the linear characteristic of the quadruple integration. In other words, the transfer characteristics from the virtual input u aM is the input of the
状態フィードバック制御器141は、仮想入力uaMから機械位置paLまでの伝達特性が式(14)で表されると考えて設計する。式(14)を式(12)に代入すると、位置目標値yrefから機械位置paLまでの特性は、ラプラス演算子sを用いて表すと
paL(s)=(K1×K2×K3×K4)
×1/(s4+K4×s3+K3×K4×s2
+K2×K3×K4×s+K1×K2×K3×K4)
×yref(s)・・・(15)
となる。ここでpaL(s)、yref(s)はそれぞれ機械位置paL、位置目標値yrefのラプラス変換されたものを表す。つまり、状態フィードバックゲインK1、K2、K3、K4を決定することにより、位置目標値yrefに対する機械位置paLの追従特性(極配置)を決定することが可能となる。
The
× 1 / (s 4 + K 4 × s 3 + K 3 × K 4 × s 2
+ K 2 × K 3 × K 4 × s + K 1 × K 2 × K 3 × K 4 )
Xy ref (s) (15)
It becomes. Here, p aL (s) and y ref (s) represent the Laplace transformed values of the machine position p aL and the position target value y ref , respectively. That is, by determining the state feedback gains K 1 , K 2 , K 3 , and K 4 , it is possible to determine the following characteristic (pole arrangement) of the machine position paL with respect to the position target value y ref .
機械位置paLの特性が決定されると、モデル位置paに相当するモータ位置paMの特性は式(10)より式(16)と計算され、モデル速度vaに相当するモータ速度vaMの特性は式(16)の両辺を微分することにより式(17)と表される。 When characteristics of the machine position p aL is determined, the characteristics of the motor position p aM corresponding to the model position p a is calculated with formula (16) from equation (10), the motor speed v aM corresponding to the model velocity v a The characteristic of is expressed by Expression (17) by differentiating both sides of Expression (16).
paM=1/ωz 2×p(2) aL+paL・・・(16) p aM = 1 / ω z 2 × p (2) aL + paL (16)
vaM=1/ωz 2×p(3) aL+p(1) aL
−2×ω(1) z/ωz 3×p(2) aL・・・(17)
v aM = 1 / ω z 2 × p (3) aL + p (1) aL
−2 × ω (1) z / ω z 3 × p (2) aL (17)
式(16)、式(17)の特性で表されるモータ位置paM、モータ速度vaMがそれぞれモデル位置pa、モデル速度vaとしてフィードバック制御部112に出力され、フィードバック制御部112は、モータ位置検出値pMをモデル位置pa、モータ速度演算値vMがモデル速度vaに追従するようにフィードバックトルクτBを演算して出力する。モータ位置検出値pMがモデル位置paに追従するとともにモータ速度演算値vMがモデル速度vaに追従するようにフィードバックトルクτBを演算することにより、制御対象1内にあり実際のモータに接続されている機械の位置の挙動を式(15)で表される特性に一致させることができる。よって、状態フィードバックゲインK1、K2、K3、K4を振動が発生しないような(一定の)極配置になるように決定することで、制御対象1内の機械に振動を励起することなく、かつ所定の(一定の)追従特性で動作させることが可能となる。
Equation (16), is output motor position p aM represented by the characteristic equation (17), the motor speed v aM each model position p a, the
次に、制振パラメータ決定部123及び制振パラメータフィルタ124の動作について詳細に説明する。
Next, operations of the vibration suppression
制振パラメータ決定部123は、パラメータ変更信号MLを受け取り、制振パラメータフィルタ124へ制振パラメータθを出力する。パラメータ変更信号MLは、制御対象1の現在の状態を表す信号である。パラメータ変更信号MLは、例えば、図3に示すアーム長が変化する直交2軸(x−y)ロボットにおけるz軸モータ1a11の回転位置に応じた(負荷の位置を決める)z軸アーム1b1の長さ(アーム長)を含む。あるいは、パラメータ変更信号MLは、例えば、図4に示すクレーンにおけるロープ1b2の長さ(ロープ長)を含む。制振パラメータ信号θは、制御対象1の振動特性を表す信号であり、例えば、共振周波数や反共振周波数、負荷慣性モーメント、バネ定数、ロープ長などである。
The damping
例えば、制振パラメータ決定部123は、図6に示すように、パラメータ変更信号MLの複数の値と制振パラメータ信号θの複数の値とが対応付けられたテーブルを有していてもよい。すなわち、例えば、パラメータ変更信号MLの複数の値と制振パラメータ信号θの複数の値との対応を予め実験的に求めておき、制振パラメータ決定部123に予め記憶しておいても良い。この場合、制振パラメータ決定部123は、図6に示すテーブルを逐次参照することにより、検出器3(図1参照)から受けたパラメータ変更信号MLの値に対応する制振パラメータ信号θすなわち共振周波数ωpや反共振周波数ωzを決定して生成する。
For example, as shown in FIG. 6, the damping
あるいは、例えば、制振パラメータ決定部123は、図6に示すテーブルに代えて、パラメータ変更信号MLの値と制振パラメータ信号θの値との関係を示す関数を有していても良い。すなわち、例えば、パラメータ変更信号MLの値と制振パラメータ信号θの値との関係を示す関数を予め実験的に求めておき、制振パラメータ決定部123に予め記憶しておいても良い。この場合、制振パラメータ決定部123は、記憶された関数を逐次参照することにより、検出器3(図1参照)から受けたパラメータ変更信号MLに対応する制振パラメータ信号θすなわち共振周波数ωpや反共振周波数ωzを決定して生成する。
Alternatively, for example, the damping
制振パラメータフィルタ124は、制振パラメータ信号θを制振パラメータ決定部123から受け取り、制振パラメータ変分信号θ’を演算する。ここで、制振パラメータ変分信号θ’は制振パラメータ信号θの時間変化量に相当するように演算され、制御対象1の特性変化を表す。例えば、制振パラメータ変分信号θ’は、微分、差分、微分+平均化フィルタ、ハイパスフィルタなどを用いて演算させる。また、制振パラメータ信号θがテーブルにより記憶されている場合は、予め制振パラメータ信号θの変分量を計算しておき、計算した変分量とパラメータ変更信号MLの時間微分との積から制振パラメータ変分信号θ’を求めてもよい。
The damping
以上のように、実施の形態1では、数式モデル121が、制振パラメータθに応じて数式モデル121の特性を変更し、モデルトルクτaから変更後の数式モデルによりモデル位置paやモデル出力yaを演算する。そして、モデル制御器122は、モデル位置paやモデル出力yaが一定の追従特性で位置目標値yrefに追従するように、制振パラメータθに応じて特性を変化させた演算によりモデルトルクτaを演算する。これにより、動作中に振動周波数が変化する制御対象に対して、動作目標値(位置指令)に対するモデル位置(モータ位置)やモデル出力(機械負荷の位置)の追従特性が一定の特性になるように指定することができるので、容易に振動抑制制御の精度を向上できる。すなわち、動作中に振動特性が変化する制御対象に対する振動抑制制御の精度を向上できる。
As described above, in the first embodiment,
また、実施の形態1では、フィードフォワード制御部111のモデル制御器122内を状態フィードバック制御器141と非線形補償器142とに分ける。非線形補償器142では、制御対象1の動特性を模擬している数式モデル121の可変パラメータに起因する非線形特性を補償するように、非線形補償器142の制御パラメータωp、ωz、ω(1) p、ω(1) z、ω(2) p、ω(2) zを制振パラメータ決定部123、制振パラメータフィルタ124に応じて変更している。これにより、数式モデル121の可変パラメータに依存せず、非線形補償器142と数式モデル121との直列接続における伝達特性が線形特性となるように非線形補償器142を動作させることができ、数式モデル121と非線形補償器142とのパラメータが可変になっても、状態フィードバック制御器141で設定した式(15)で表される所定の(一定の)追従特性を保つことが可能になっている。よって、動作中に振動周波数が変化する制御対象に対して、簡単に(一定の)追従特性が設定でき、かつ高い振動抑制効果が得られる。
In the first embodiment, the
また、実施の形態1では、制振パラメータ決定部123が、パラメータ変更信号MLの複数の値と制振パラメータ信号θの複数の値とが対応付けられたテーブルを有し、そのテーブルを参照することにより、検出器3から受けたパラメータ変更信号MLに対応する制振パラメータ信号θを生成する。これにより、各サンプリング時における計算負荷を低減することが可能となる。
In the first embodiment, the damping
あるいは、実施の形態1では、制振パラメータ決定部123が、パラメータ変更信号MLの値と制振パラメータ信号θの値との関係を示す関数を有し、その関数を参照することにより、検出器3から受けたパラメータ変更信号MLに対応する制振パラメータ信号θを生成する。これにより、サンプリング時における計算負荷を低減することが可能となる。
Alternatively, in the first embodiment, the vibration suppression
また、実施の形態1では、制御対象の特性変化に応じて、フィードフォワード制御部111の特性を変化させる制振パラメータ決定部123と制振パラメータフィルタ124とを設けている。制振パラメータフィルタ124は、nを1より大きな整数とするとき、制振パラメータ信号θのn階微分もしくはn階差分を行うことにより制振パラメータ変分信号θ’を演算する。数式モデル121は、制振パラメータ信号θ及び制振パラメータ変分信号θ’に応じて、演算に用いる数式モデルの特性を変更し、モデル制御器122は、制振パラメータ信号θ及び制振パラメータ変分信号θ’に応じて特性を変化させた演算によりモデルトルクτaを演算する。すなわち、動作中に特性が変化する制御対象では、その応答が振動特性(振動周波数)のみならず、その振動特性(振動周波数)の時間的な変化率にも影響を受けるが、制振パラメータフィルタ124により演算された振動特性の時間的な変化率も考慮してフィードフォワード制御を行うことにより、その影響も低減することが可能となる。これにより、動作中に特性が変化する制御対象に対しても高応答化・低振動化が実現できる。
In the first embodiment, the damping
また、実施の形態1では、数式モデル121が演算に用いる数式モデルは、制御対象1の動特性が振動的な機械系でモデル化されたものである。これにより、数式モデルを用いた振動抑制制御に対して、振動抑制効果を持たせることが可能となる。
In the first embodiment, the mathematical model used by the
また、実施の形態1では、制御対象1の現在の振動特性を表す制振パラメータθに応じて数式モデル121の特性を変更し、その際に、動作目標値から内部状態または、モデル出力の応答特性にかかる極配置を一定にするようフィードフォワード制御部111の特性を逐次変更する。これにより、動作中に振動周波数が変化する制御対象に対して、制御対象の位置を一定の追従特性で動作目標値(位置指令)に追従させることができる。
In the first embodiment, the characteristic of the
なお、実施の形態1では、状態フィードバック制御器141において機械位置paLの微分、2階微分、3階微分を用いて状態フィードバック制御則を実現しているが、実際には、図7に示すようにそれらと等価な値を演算してもよい。すなわち、モータ制御装置100iのフィードフォワード制御部111iはモデル制御器122iを有し、モデル制御器122iは、状態フィードバック制御器141iを有する。状態フィードバック制御器141iは、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLから、下記の式(18)、(19)、(20)を用いることより、実施の形態1で求めたものと等価な値を演算することができる。
In the first embodiment, the
p(1) aL=vaL・・・(18) p (1) aL = v aL (18)
p(2) aL=ωz 2×(paM−paL)・・・(19) p (2) aL = ω z 2 × (p aM -p aL) ··· (19)
p(3) aL=ωz 2×(vaM−vaL)
+2×ω(1) z×ωz×(paM−paL)・・・(20)
p (3) aL = ω z 2 × (v aM -v aL)
+ 2 × ω (1) z × ω z × ( paM− paL ) (20)
微分演算を複数回行うことは量子化誤差など増大するためあまり望ましくないが、式(18)、(19)、(20)を用いることで微分演算の回数を減らすことが可能となり、数値的に安定なフィードフォワード制御部111iを得ることが可能となる。
It is not desirable to perform the differential operation a plurality of times because the quantization error increases, but it is possible to reduce the number of differential operations by using the equations (18), (19), and (20). It is possible to obtain a stable
実施の形態2.
次に、実施の形態2にかかるモータ制御装置200について図8を用いて説明する。図8は、モータ制御装置200の構成を示す図である。以下では、実施の形態1と異なる点を中心に説明する。
Next, a
本実施の形態と実施の形態1のモータ制御装置の差異は、本実施の形態におけるモータ制御装置200では、制振パラメータ変分信号θ’を使用しない点にある。
The difference between the motor control device of the present embodiment and the first embodiment is that the
フィードフォワード制御部211は、数式モデル221及びモデル制御器222を有しており、制振パラメータフィルタ124(図1参照)を有していない。数式モデル221は、制振パラメータ信号θに応じて、演算に用いる数式モデルの特性を変更し、モデル制御器222は、制振パラメータ信号θに応じて特性を変化させた演算によりモデルトルクτaを演算する。
The
次に、フィードフォワード制御部211の動作について詳細に説明する。本実施の形態においても数式モデル221が演算に用いる数式モデルを図2のようにモータがバネを介して機械負荷を起動する2慣性系モデルで表すこととして説明する。つまり、数式モデル221は式(3)、(4)もしくは(9)、(10)で表される運動方程式または、動特性を有し、後述する非線形補償器242からモータトルクτaMを、制振パラメータ決定部123から共振周波数ωp、反共振周波数ωzを入力し、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを式(3)、(4)もしくは(9)、(10)から計算し、モータ位置paMをモデル位置paとして、モータ速度vaMをモデル速度vaとしてモデル制御器222とフィードバック制御部112へ出力し、機械位置paLをモデル出力ya、機械速度vaLを内部変数xaとしてモデル制御器222へ出力する。
Next, the operation of the
なお、ここで説明したものは数式モデル221の一例であり、数式モデル221の運動方程式又は動特性が式(3)、(4)もしくは(9)、(10)に限定されるものではない。
In addition, what was demonstrated here is an example of the
次に、本実施の形態におけるモデル制御器222について図9を用いて詳細に説明する。図9は、モデル制御器222の構成及び動作を表すブロック線図である。
Next, the
モデル制御器222は、状態フィードバック制御器241及び非線形補償器242を有する。状態フィードバック制御器241は、位置目標値yref、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを受けて、仮想入力uaMを演算し、演算した仮想入力uaMを非線形補償器242へ供給する。非線形補償器242は、仮想入力uaM、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを受けて、モータトルクτaMを演算し、演算したモータトルクτaMを数式モデル221及びトルク加算器113へ供給する。次にこれらの動作について詳細に説明する。
The
非線形補償器242は、仮想入力uaM、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを受けて、数式モデル221に存在する非線形特性を補償し、仮想入力uaMから機械位置paLまでの伝達特性がほぼ線形特性となるように式(21)を用いて、モータトルクτaMを演算する。そして、非線形補償器242は、演算したモータトルクτaMを数式モデル221及びトルク加算器113へ供給する。式(21)は式(11)において共振周波数ωp、反共振周波数ωzの微分と2階微分をそれぞれ0とした式である。なお、図示していないが、共振周波数ωp、反共振周波数ωzは制振パラメータ決定部123から入力させる制振パラメータθに相当する。
The
τaM=JM/ωz 2×uaM
+JM×ωp 2×(paM−paL)・・・(21)
τ aM = J M / ω z 2 × u aM
+ J M × ω p 2 × ( paM− paL ) (21)
状態フィードバック制御器241は、位置目標値yref、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを受けて、フィードフォワード制御部211の特性が所定の特性となるように仮想入力uaMを計算し、非線形補償器242へ出力する。本実施の形態においては、下記の式(22)に示される状態フィードバック制御則を用いて仮想入力uaMを計算する。式(22)は式(12)に式(18)、(19)、(20)を代入して得られる図9の制御則において、共振周波数ωp、反共振周波数ωzの微分と2階微分をそれぞれ0としたものになっている。そして計算した仮想入力uaMを非線形補償器242へ出力する。ここでK1、K2、K3、K4は状態フィードバックゲインであり、これらの値を調整することによりモータ制御装置200の追従特性を決定する。なお、式(22)は式(12)とほぼ等価であり、状態フィードバックと同じ働きをする。つまり、K1、K2、K3、K4により位置目標値yrefから機械位置paLまでの特性(極配置)を決定することが可能となる。
The
uaM=K1×K2×K3×K4×(yref−paL)
−K2×K3×K4×vaL
−K3×K4/ωz 2×(paM−paL)
−K4/ωz 2×(vaM−vaL)・・・(22)
u aM = K 1 × K 2 × K 3 × K 4 × (y ref −pa L )
-K 2 × K 3 × K 4 × vaL
-K 3 × K 4 / ω z 2 × (p aM -p aL)
−K 4 / ω z 2 × ( vaM− vaL ) (22)
ここで、産業用のモータに使用されるモータ制御装置を考えると、そのようなモータ制御装置は、低コスト化のために安価なメモリを使用することが多い。そのため各制振パラメータ信号を記憶するために十分なビット数が取れず、そのため制振パラメータ信号の分解能が粗くなる。分解能が粗い信号を微分、または変分すると量子化誤差を増大させてしまい、その結果実施の形態1におけるフィードフォワード制御部からの出力が必要以上に大きくなる場合や、理論どおりの特性が得られなくなる場合がある。
Here, considering a motor control device used for an industrial motor, such a motor control device often uses an inexpensive memory for cost reduction. Therefore, a sufficient number of bits cannot be obtained for storing each damping parameter signal, and the resolution of the damping parameter signal becomes rough. Differentiating or changing the signal with coarse resolution increases the quantization error, and as a result, the output from the feedforward control unit in
それに対し、実施の形態2にかかるモータ制御装置200では、制振パラメータ信号の微分、変分に当たる制振パラメータ変分信号を使用しないことにより、量子化誤差の影響を防止できるとともに、安価なメモリで制御装置を実現でき、かつ簡単に追従特性の設定が可能となり、その計算時間も短縮することができる。
On the other hand, in the
なお、実施の形態2では、状態フィードバック制御器241は式(22)を用いて仮想入力uaMを計算するが、式(12)を用いて仮想入力uaMを計算してもよい。
In the second embodiment, the
実施の形態3.
次に、実施の形態3にかかるモータ制御装置300について図10を用いて説明する。図10は、モータ制御装置300の構成を示す図である。以下では、実施の形態1と異なる点を中心に説明する。
Next, a
本実施の形態と実施の形態1との差異は、実施の形態1がモータ位置検出値pMを所定の位置目標値yrefに追従させる位置制御であるのに対し、本実施の形態はモータ速度演算値vMを速度目標値(動作目標値)vrefに追従させる速度制御であることである。 The difference between the present embodiment and the first embodiment is that the first embodiment is a position control that causes the motor position detection value p M to follow a predetermined position target value y ref , whereas the present embodiment is different from the motor of the present embodiment in that the motor position detection value p M follows the predetermined position target value y ref. This is speed control that causes the speed calculation value v M to follow the speed target value (operation target value) v ref .
モータ制御装置300は、フィードフォワード制御部311及びフィードバック制御部312を有する。フィードフォワード制御部311は、速度目標値vrefを外部から受け、速度目標値vrefに応じた制御を行う。フィードバック制御部312は、検出器2からフィードバックされた制御対象1(モータ1a)のモータ位置検出値pMを受けて、モータ位置検出値pMに応じた速度制御を行う。
The
具体的には、フィードフォワード制御部311は、モデル制御器322を有する。モデル制御器322は、速度目標値vrefを外部から受け、モデル位置pa、モデル速度va、内部状態xa、モデル出力yaを数式モデル321から受け、制振パラメータ信号θを制振パラメータ決定部123から受け、制振パラメータ変分信号θ’を制振パラメータフィルタ124から受ける。モデル制御器322は、これらの入力の値を用いた状態フィードバックを行う。すなわち、モデル制御器322は、数式モデル321の各出力と、制振パラメータ信号θ及び制振パラメータ変分信号θ’に応じて変化するゲインとの乗算に基づき、最終的にはモデル出力yaとモデル速度vaとが速度目標値vrefに追従するように、モデルトルクτaを計算して数式モデル321及びトルク加算器113へ供給する。
Specifically, the
フィードバック制御部312は、速度制御器131、速度演算器133を有するが、位置制御器132(図1参照)を有さない。速度制御器131は、速度演算器133の出力であるモータ速度演算値vMをモデル速度vaに追従させるようにフィードバックトルクτBを計算する。そして計算したフィードバックトルクτBをトルク加算器113へ出力する。
The
次に、フィードフォワード制御部311の各構成における動作について詳細に説明する。
Next, the operation of each configuration of the
本実施の形態においても数式モデル321を図2のようにモータがバネを介して機械負荷を起動する2慣性系モデルで表すこととして説明する。よって、数式モデル321は式式(3)、(4)もしくは(5)、(6)、(9)、(10)で表される運動方程式または動特性を有し、モータトルクτaM、制振パラメータ信号θである共振周波数ωp、反共振周波数ωzからモータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを式(3)、(4)もしくは(5)、(6)、(9)、(10)から計算する。数式モデル321は、モータ位置paMをモデル位置paとして、モータ速度vaMをモデル速度vaとして、モデル制御器322及びフィードバック制御部312へ供給し、機械位置paLを内部変数xaとして、機械速度vaLをモデル出力yaとして、モデル制御器322へ供給する。本実施の形態において、機械速度vaLをモデル出力yaとして供給するのは、本実施の形態におけるモータ制御装置300が速度制御を行うためである。
Also in the present embodiment, the
なお、ここで説明したものは数式モデル321の一例であり、本実施の形態の数式モデル321の運動方程式又は動特性が式(3)、(4)もしくは(9)、(10)に限定されるものではない。
In addition, what was demonstrated here is an example of the
次に、本実施の形態におけるモデル制御器322について図11を用いて詳細に説明する。図11は、モデル制御器322の構成及び動作を表すブロック線図である。
Next, the
モデル制御器322は、状態フィードバック制御器341を有する。状態フィードバック制御器341は、速度目標値vref及び機械速度vaLを受けて、フィードフォワード制御部311の特性が所定の特性となるように仮想入力uaMを計算し、非線形補償器142へ供給する。本実施の形態においては、状態フィードバック制御器341は、下記の式(23)に示される状態フィードバック制御則を用いて仮想入力uaMを計算する。そして、状態フィードバック制御器341は、計算した仮想入力uaMを非線形補償器142へ出力する。ここでK2、K3、K4は状態フィードバックゲインであり、状態フィードバック制御器341は、これらの値を調整することによりモータ制御装置300の追従特性を決定する。
The
uaM=K2×K3×K4×(vref−vaL)
−K3×K4×v(1) aL
−K4×v(2) aL・・・(23)
u aM = K 2 × K 3 × K 4 × (v ref −vaL )
−K 3 × K 4 × v (1) aL
−K 4 × v (2) aL (23)
次に、フィードフォワード制御部311の特性について説明する。
Next, characteristics of the
実施の形態1と同様に、本実施の形態においても仮想入力uaMから機械位置paMまでの特性は式(14)となる。式(14)に式(23)の状態フィードバック則を代入すると、速度目標値vrefから機械速度vaLまでの特性は式(24)となる。 Similar to the first embodiment, in the present embodiment, the characteristic from the virtual input u aM to the machine position pa am is expressed by Expression (14). When the state feedback law of Expression (23) is substituted into Expression (14), the characteristic from the speed target value v ref to the machine speed v aL becomes Expression (24).
vaL(s)=(K2×K3×K4)
×1/(s3+K4×s2+K3×K4×s+K2×K3×K4)
×vref(s)・・・(24)
ここでvaL(s)は機械速度のラプラス変換されたもの、vref(s)は速度目標値のラプラス変換されたものを表している。つまり、状態フィードバックゲインK2、K3、K4を決定することにより、速度目標値vrefから機械速度vaLまでの特性(極配置)を決定することが可能となる。
v aL (s) = (K 2 × K 3 × K 4 )
× 1 / (s 3 + K 4 × s 2 + K 3 × K 4 × s + K 2 × K 3 × K 4 )
Xv ref (s) (24)
Here, v aL (s) represents the Laplace transformed machine speed, and v ref (s) represents the Laplace transformed target speed value. That is, by determining the state feedback gains K 2 , K 3 , and K 4 , it is possible to determine the characteristics (pole arrangement) from the speed target value v ref to the machine speed v aL .
機械速度vaLの特性が決定されると、モデル速度vaに相当するモータ速度vaMの特性は式(17)と同様に下記の式(25)で表される。なお、式(25)では、p(1) aL=vaLを代入し右辺をvaLのみで表現している。 When the characteristics of the machine speed v aL is determined, the characteristics of the motor speed v aM corresponding to the model velocity v a is expressed by Equation (17) as well as the following equation (25). In Expression (25), p (1) aL = vaL is substituted, and the right side is expressed only by vaL .
vaM=1/ωz 2×v(2) aL+vaL
−2×ω(1) z/ωz 3×v(1) aL・・・(25)
v aM = 1 / ω z 2 × v (2) aL + v aL
-2 × ω (1) z / ω z 3 × v (1) aL (25)
式(25)の特性で表されるモータ速度vaMがモデル速度vaとしてフィードバック制御部312に出力され、フィードバック制御部312は、モータ速度演算値vMがモデル速度vaに追従するようにフィードバックトルクτBを出力する。モータ速度演算値vMがモデル速度vaに追従するようにフィードバックトルクτBを演算することにより、制御対象1内にあり実際のモータに接続されている機械の速度の挙動を式(24)で表される特性に一致させることができる。よって、状態フィードバックゲインK2、K3、K4を振動が発生しないような(一定の)極配置になるように決定することで、制御対象1内の機械に振動を励起することなく、かつ所定の(一定の)追従特性で動作させることが可能となる。
Motor speed v aM represented by the characteristic equation (25) is outputted to the
以上のように、実施の形態3にかかるモータ制御装置300によれば、実施の形態1と同等の効果を速度制御においても得ることが可能となり、本発明のモータ制御装置の用途を広げることが可能となる。
As described above, according to the
なお、実施の形態3では、エンコーダなどの検出器2によりモータ動作目標値pMを検出し、それを速度演算器133によってモータ速度演算値vMを計算しているが、レゾルバやタコジェネレータ、ホール素子等を用いて直接モータ速度演算値vMを計測してもよい。
In the third embodiment, it detects the motor operating target value p M by
また、式(23)の演算において、式(23)に式(19)と(20)を代入し、モータ速度の微分、2階微分を使用しない演算にしても良い。 Further, in the calculation of Expression (23), Expressions (19) and (20) may be substituted into Expression (23) so that the motor speed differentiation and second order differentiation are not used.
また、本実施の形態においても、実施の形態2と同様に、共振周波数、反共振周波数の微分、2階微分を0として、これらの値を微分もしくは変分により増大する量子化誤差の影響を小さくしても良い。 Also in the present embodiment, as in the second embodiment, the resonance frequency and anti-resonance frequency differentiation, the second-order differentiation are set to 0, and the influence of the quantization error that increases these values by differentiation or variation is affected. It may be small.
実施の形態4.
次に、実施の形態4にかかるモータ制御装置400について説明する。以下では、実施の形態2と異なる点を中心に説明する。
Next, a
本実施の形態と実施の形態2との差異はモデル制御器の構成である。 The difference between the present embodiment and the second embodiment is the configuration of the model controller.
実施の形態4にかかるモータ制御装置400のフィードフォワード制御部411は、例えば、図12に示すようなモデル制御器422を有する。図12は、モデル制御器422の構成及び動作を表すブロック線図である。
The
モデル制御器422は、図12に示すように、そのゲイン変更方法が実施の形態2と異なる。すなわち、モデル制御器422は、下記の式(26)を用いてモータトルクτaMを演算する。式(26)において、Kp1はモデル位置制御ゲイン、Kv1はモデル速度制御ゲイン、Kcpはねじり補償位置制御ゲイン、Kcvはねじり補償速度制御ゲインを表しており、モデル制御器422は、これらの値を制振パラメータ信号θ(共振周波数ωp、反共振周波数ωz)に応じて変更する。
As shown in FIG. 12, the
τaM=Kv1×{Kp1×(yref−paM)−vaM}
−Kcv×(vaM−vaL)
−Kcp×(paM−paL)・・・(26)
τ aM = K v1 × {K p1 × (y ref -p aM) -v aM}
-Kcv * ( vaM- vaL )
-Kcp * ( paM- paL ) ... (26)
そして、モータトルクτaMから機械位置paLまでの特性において共振周波数ωp、反共振周波数ωzの微分が0であるとし、モータトルクτaMから機械位置paLまでの特性を線形化すると式(27)の伝達関数で表すことが可能である。 Then, the resonance frequency omega p in the characteristic from the motor torque tau aM to machine position p aL, a derivative of the anti-resonance frequency omega z is 0, when linearizing the characteristic up machine position p aL from the motor torque tau aM formula It can be expressed by the transfer function of (27).
paL(s)=1/(JM×s2)×ωz 2/(s2+ωp 2)
×τaM(s)・・・(27)
p aL (s) = 1 / (J M × s 2 ) × ω z 2 / (s 2 + ω p 2 )
× τ aM (s) (27)
式(27)において、paL(s)は機械位置のラプラス変換されたもの、τaM(s)はモータトルクτaMのラプラス変換されたものを表している。よって、式(27)に式(26)代入することで、位置目標値yrefから機械位置paLまでの特性は下記の式(28)の伝達関数で表すことが可能である。式(28)においてyref(s)は動作目標値のラプラス変換されたものを表している。 In the equation (27), p aL (s) represents the Laplace transformed machine position, and τ aM (s) represents the Laplace transformed motor torque τ aM . Therefore, by substituting equation (26) into equation (27), the characteristic from the position target value y ref to the machine position paL can be expressed by the transfer function of the following equation (28). In equation (28), y ref (s) represents the Laplace transformed target operation value.
paL(s)=ωz 2/JM×Kv1×Kp1
×1/{s4+(Kv1+Kcv)/JM×s3
+(ωp 2+(Kv1×Kcp+Kcv)/JM)×s2
+ωz 2/JM×(Kv1+2×Kcv)×s
+ωz 2/JM×(Kv1×Kp1+2×Kcp)}
×yref(s)・・・(28)
p aL (s) = ω z 2 / J M × K v1 × K p1
× 1 / {s 4 + (K v1 + K cv ) / J M × s 3
+ (Ω p 2 + (K v1 × K cp + K cv ) / J M ) × s 2
+ Ω z 2 / J M × (K v1 + 2 × K cv ) × s
+ Ω z 2 / J M × (K v1 × K p1 + 2 × K cp )}
Xy ref (s) (28)
次に所定の極を持つ特性多項式を下記の式(29)で表す。 Next, a characteristic polynomial having a predetermined pole is expressed by the following equation (29).
s4+a3 *s3+a2 *s2+a1 *s+a0 *・・・(29) s 4 + a 3 * s 3 + a 2 * s 2 + a 1 * s + a 0 * (29)
式(29)においてa3 *、a2 *、a1 *、a0 *は式(29)の特性多項式が所定の極を持つように決定する係数である。つまり、モデル制御器422は、式(28)で表される位置目標値yrefから機械位置paLまでの伝達関数の分母多項式が常に式(29)と一致するようにモデル位置制御ゲインKp1、モデル速度制御ゲインKv1、ねじり位置制御ゲインKcp、ねじり速度制御ゲインKcvを変更すればよい。
In Expression (29), a 3 * , a 2 * , a 1 * , and a 0 * are coefficients that are determined so that the characteristic polynomial of Expression (29) has a predetermined pole. In other words, the
具体的には、モデル制御器422は、制振パラメータ決定部123から出力された共振周波数ωp、反共振周波数ωzを用いて、モデル位置制御ゲインKp1、モデル速度制御ゲインKv1、ねじり位置制御ゲインKcp、ねじり速度制御ゲインKcvを、式(30)、(31)、(32)、(33)のように変更すれば、式(28)で表される伝達関数の分母多項式を常に、式(29)に一致させることができる。従って、共振周波数ωp、反共振周波数ωzが変化する制御対象に対しても、常に所定の(一定の)極配置が実現でき、所定の(一定の)追従特性で機械位置paLを位置目標値yrefに追従させることが可能となる。
Specifically, the
Kp1=(2×ωz 2a2 *−2×ωp 2×ωz 2−a0 *)
×1/(2×ωz 2×a3 *−a1 *)・・・(30)
K p1 = (2 × ω z 2 a 2 * −2 × ω p 2 × ω z 2 −a 0 * )
× 1 / (2 × ω z 2 × a 3 * −a 1 * ) (30)
Kv1=JM/ωz 2×(2×ωz 2×a3 *−a1 *)・・・(31) K v1 = J M / ω z 2 × (2 × ω z 2 × a 3 * −a 1 * ) (31)
Kcp=JM/ωz 2×(a0 *+ωz 2×ωp 2−ωz 2×a2 *)
・・・(32)
K cp = J M / ω z 2 × (a 0 * + ω z 2 × ω p 2 −ω z 2 × a 2 * )
... (32)
Kcv=JM/ωz 2×(a1 *−ωz 2a3 *)・・・(33) K cv = J M / ω z 2 × (a 1 * -ω z 2 a 3 *) ··· (33)
したがって、本実施の形態におけるモデル制御器422は、位置目標値yrefを外部から受け、モータ位置paM、モータ速度vaM、機械位置paL、機械速度vaLを数式モデル221から受ける。そして、モデル制御器422は、制振パラメータ決定部123から出力された共振周波数ωp、反共振周波数ωzに基づき、式(30)、(31)、(32)、(33)を用いて、モデル位置制御ゲインKp1、モデル速度制御ゲインKv1、ねじり位置制御ゲインKcp、ねじり速度制御ゲインKcvを決定し、これらの値と式(26)とを用いてモデルトルクτaMを演算し、演算したモデルトルクτaMを数式モデル221へ出力する。これにより、機械位置paLを所定の(一定の)追従特性(極配置)により、位置目標値yrefに追従させることが可能となる。
Therefore, the
なお、本実施の形態では、実施の形態2と同様にモータ位置検出値pMを所定の動作目標値prefに追従させる位置制御について説明したが、モータ速度演算値vMを速度目標値vrefに追従させる速度制御に適用しても良い。 In the present embodiment, the position control for causing the motor position detection value p M to follow the predetermined operation target value p ref has been described as in the second embodiment, but the motor speed calculation value v M is used as the speed target value v. You may apply to the speed control made to track ref .
また、本実施の形態では、実施の形態2と同様に数式モデルをモータがバネを介して機械負荷を起動する2慣性系モデルであるものとしたが、必ずしも数式モデルが2慣性系モデルである必要はなく、別のモデルであってもよい。 In this embodiment, the mathematical model is a two-inertia model in which the motor activates the mechanical load via the spring as in the second embodiment. However, the mathematical model is not necessarily a two-inertia model. There is no need, and another model may be used.
以上のように、本発明にかかるモータ制御装置は、産業用機械装置を駆動するモータの制御に有用である。 As described above, the motor control device according to the present invention is useful for controlling a motor that drives an industrial machine.
1 制御対象
2 検出器
4 電流制御器
100、100i、200、300、400 モータ制御装置
111、111i、211、311、411 フィードフォワード制御部
112、312 フィードバック制御部
113 トルク加算器
121、221、321 数式モデル
122、122i、222、322、422 モデル制御器
123 制振パラメータ決定部
124 制振パラメータフィルタ
131 速度制御器
132 位置制御器
133 速度演算器
141、141i、241、341 状態フィードバック制御器
142、242 非線形補償器
DESCRIPTION OF
Claims (7)
前記制御対象の動作を動作目標値に追従させるようにモデルトルクを生成するフィードフォワード制御部と、
前記モデルトルクに応じて前記モータに対するトルク指令を発生させる発生部と、
を備え、
前記フィードフォワード制御部は、
前記制御対象の振動関連情報に応じて、前記制御対象の振動特性を表す振動パラメータを生成する生成部と、
前記振動パラメータに応じて、前記制御対象の動特性を模擬した数式モデルを変更し、前記モデルトルクから前記変更された数式モデルにより、前記制御対象の動作状態を含むモデル変数を演算する第1の演算部と、
前記モデル変数が一定の追従特性で前記動作目標値に追従するように、前記モデル変数と前記動作目標値から前記振動パラメータに応じて特性を変化させた演算により前記モデルトルクを演算する第2の演算部と、
を有する
ことを特徴とするモータ制御装置。 A motor control device for controlling the operation of a controlled object having a motor and a vibratable element,
A feedforward control unit that generates a model torque so that the operation of the control target follows an operation target value;
A generator for generating a torque command for the motor according to the model torque;
With
The feedforward control unit
According to the vibration-related information of the control target, a generation unit that generates a vibration parameter that represents the vibration characteristics of the control target;
A mathematical model that simulates the dynamic characteristics of the controlled object is changed according to the vibration parameter, and a model variable that includes an operating state of the controlled object is calculated from the model torque based on the changed mathematical model. An arithmetic unit;
A second torque that calculates the model torque by calculating the characteristic according to the vibration parameter from the model variable and the operation target value so that the model variable follows the operation target value with a constant tracking characteristic. An arithmetic unit;
A motor control device comprising:
前記動作目標値に対する前記モデル変数の追従特性が一定になるように、前記モデルトルクを演算するための仮想入力を生成する第3の演算部と、
前記仮想入力から前記モデル変数までの伝達特性が線形特性になるように前記数式モデルの非線形性を補償して、前記モデルトルクを演算する補償部と、
を有する
ことを特徴とする請求項1に記載のモータ制御装置。 The second calculation unit includes:
A third calculation unit for generating a virtual input for calculating the model torque so that the following characteristic of the model variable with respect to the operation target value is constant;
A compensation unit that compensates for nonlinearity of the mathematical model so that a transfer characteristic from the virtual input to the model variable becomes a linear characteristic, and calculates the model torque;
The motor control device according to claim 1, comprising:
ことを特徴とする請求項1又は2に記載のモータ制御装置。 The generation unit includes a table in which a plurality of values of the vibration related information and a plurality of values of the vibration parameter are associated with each other, and corresponds to the input vibration related information by referring to the table. The motor control device according to claim 1, wherein the vibration parameter is generated.
ことを特徴とする請求項1又は2に記載のモータ制御装置。 The generation unit includes a function indicating a relationship between the value of the vibration related information and the value of the vibration parameter, and generates the vibration parameter corresponding to the input state information by referring to the function. The motor control device according to claim 1, wherein the motor control device is a motor control device.
前記第1の演算部は、前記振動パラメータ及び前記第2の振動パラメータに応じて、前記数式モデルを変更し、
前記第2の演算部は、前記振動パラメータ及び前記第2の振動パラメータに応じて特性を変化させた演算により前記モデルトルクを演算する
ことを特徴とする請求項3又は4に記載のモータ制御装置。 When n is an integer larger than 1, the apparatus further includes a second generation unit that calculates a second vibration parameter by performing n-order differentiation or n-order difference of the vibration parameter,
The first calculation unit changes the mathematical model according to the vibration parameter and the second vibration parameter,
5. The motor control device according to claim 3, wherein the second calculation unit calculates the model torque by calculation with characteristics changed according to the vibration parameter and the second vibration parameter. .
ことを特徴とする請求項1から5のいずれか1項に記載のモータ制御装置。 6. The motor control device according to claim 1, wherein the mathematical model is a model in which dynamic characteristics of the control target are modeled by a vibration mechanical system. 6.
ことを特徴とする請求項2に記載のモータ制御装置。 The motor control device according to claim 2, wherein the third calculation unit generates the virtual input so that a pole arrangement in a response characteristic of the model variable with respect to the operation target value is constant.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011045055A JP5441944B2 (en) | 2011-03-02 | 2011-03-02 | Motor control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011045055A JP5441944B2 (en) | 2011-03-02 | 2011-03-02 | Motor control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2012182933A true JP2012182933A (en) | 2012-09-20 |
JP5441944B2 JP5441944B2 (en) | 2014-03-12 |
Family
ID=47013659
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011045055A Active JP5441944B2 (en) | 2011-03-02 | 2011-03-02 | Motor control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5441944B2 (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015019563A (en) * | 2013-06-10 | 2015-01-29 | 株式会社リコー | Control device, drive device, and image forming apparatus |
JP2016190305A (en) * | 2015-03-31 | 2016-11-10 | Dmg森精機株式会社 | Parameter setting method of positioner, parameter setting device, and positioner having the parameter setting device |
CN108614426A (en) * | 2018-06-06 | 2018-10-02 | 黄山学院 | A kind of Multi Mobile Robots Formation's robust control method based on interference observer |
CN110382176A (en) * | 2017-03-02 | 2019-10-25 | 物理仪器(Pi)两合有限公司 | Device and driver for motion analysis |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108614425B (en) * | 2018-06-06 | 2021-03-16 | 黄山学院 | Self-adaptive integral sliding mode control method for mobile robot |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06274228A (en) * | 1993-03-18 | 1994-09-30 | Mitsubishi Electric Corp | Numerical control device |
JPH08168280A (en) * | 1994-12-08 | 1996-06-25 | Mitsubishi Electric Corp | Speed controller and speed and position controller for motor |
JP2003216243A (en) * | 2002-01-18 | 2003-07-31 | Yaskawa Electric Corp | Robot controller |
JP2004070790A (en) * | 2002-08-08 | 2004-03-04 | Mitsubishi Electric Corp | Positional controller for machinery and position control system for machinery |
JP2005038311A (en) * | 2003-07-18 | 2005-02-10 | Fuji Electric Fa Components & Systems Co Ltd | Machine control device |
-
2011
- 2011-03-02 JP JP2011045055A patent/JP5441944B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06274228A (en) * | 1993-03-18 | 1994-09-30 | Mitsubishi Electric Corp | Numerical control device |
JPH08168280A (en) * | 1994-12-08 | 1996-06-25 | Mitsubishi Electric Corp | Speed controller and speed and position controller for motor |
JP2003216243A (en) * | 2002-01-18 | 2003-07-31 | Yaskawa Electric Corp | Robot controller |
JP2004070790A (en) * | 2002-08-08 | 2004-03-04 | Mitsubishi Electric Corp | Positional controller for machinery and position control system for machinery |
JP2005038311A (en) * | 2003-07-18 | 2005-02-10 | Fuji Electric Fa Components & Systems Co Ltd | Machine control device |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015019563A (en) * | 2013-06-10 | 2015-01-29 | 株式会社リコー | Control device, drive device, and image forming apparatus |
JP2016190305A (en) * | 2015-03-31 | 2016-11-10 | Dmg森精機株式会社 | Parameter setting method of positioner, parameter setting device, and positioner having the parameter setting device |
CN110382176A (en) * | 2017-03-02 | 2019-10-25 | 物理仪器(Pi)两合有限公司 | Device and driver for motion analysis |
JP2020511318A (en) * | 2017-03-02 | 2020-04-16 | フィジック インストゥルメント(ピーアイ)ゲーエムベーハー アンド ツェーオー.カーゲー | Device and drive for analyzing movement |
CN110382176B (en) * | 2017-03-02 | 2022-07-29 | 物理仪器(Pi)两合有限公司 | Device and drive for motion analysis |
CN108614426A (en) * | 2018-06-06 | 2018-10-02 | 黄山学院 | A kind of Multi Mobile Robots Formation's robust control method based on interference observer |
CN108614426B (en) * | 2018-06-06 | 2021-03-16 | 黄山学院 | Multi-mobile-robot formation robust control method based on disturbance observer |
Also Published As
Publication number | Publication date |
---|---|
JP5441944B2 (en) | 2014-03-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5496365B2 (en) | Motor control device | |
JP4879173B2 (en) | Electric motor control device | |
JP4391218B2 (en) | Servo control device | |
JP4577107B2 (en) | Machine position controller | |
US10261520B2 (en) | Motor controller and industrial machine | |
JP5441944B2 (en) | Motor control device | |
WO2015111298A1 (en) | Motor control device | |
KR20150006016A (en) | Trajectory control device for articulated robot, and control method | |
JP5916583B2 (en) | Weaving control device for articulated robot | |
JP2009110492A (en) | Position controller | |
JPWO2013061362A1 (en) | Actuator positioning control system with wave gear device | |
JP2013054436A (en) | Control method and controller | |
JP5989694B2 (en) | Control device, control method, and control program | |
JP2004070790A (en) | Positional controller for machinery and position control system for machinery | |
JP5283804B1 (en) | Servo control device | |
JP2016149918A (en) | Motor control apparatus | |
JP5037065B2 (en) | Machine control device | |
JPWO2002082194A1 (en) | Servo control device | |
JP2009081923A (en) | Motor control system and parameter adjusting method thereof | |
JP4367041B2 (en) | Machine control device | |
JP5084196B2 (en) | Electric motor control apparatus and electric motor control method | |
JP2005269758A (en) | Motor controller | |
KR20180028846A (en) | Apparatus for controlling servo | |
Malavatu et al. | Tip-deflection Tracking of Flexible Manipulator through Equi-dominance Controller | |
JP2003274684A (en) | Servo controlling apparatus |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120927 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20131108 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20131119 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20131217 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5441944 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |