JP2019133537A - Actuator controller and actuator control method - Google Patents
Actuator controller and actuator control method Download PDFInfo
- Publication number
- JP2019133537A JP2019133537A JP2018016908A JP2018016908A JP2019133537A JP 2019133537 A JP2019133537 A JP 2019133537A JP 2018016908 A JP2018016908 A JP 2018016908A JP 2018016908 A JP2018016908 A JP 2018016908A JP 2019133537 A JP2019133537 A JP 2019133537A
- Authority
- JP
- Japan
- Prior art keywords
- unit
- actuator
- signal
- value
- error
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Feedback Control In General (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
Description
本発明は、アクチュエータ制御装置及びアクチュエータ制御方法に関する。 The present invention relates to an actuator control device and an actuator control method.
アクチュエータに接続される被駆動体を意図した力で動かすために、アクチュエータの発生力を目標発生力に追従させるようアクチュエータを制御するアクチュエータ制御装置がある。アクチュエータがモータ等の回転体により動力を発生させる装置であれば、アクチュエータ制御装置は、アクチュエータの発生トルクを目標発生トルクに追従させるようアクチュエータを制御する。但し、トルクは力に比例するため、発生トルクを目標発生トルクに追従させることは、発生力を目標発生力に追従させることに相当する。これを実現するには、アクチュエータ制御装置は、発生力を検出するセンサーの情報を元に、アクチュエータをフィードバック制御する。しかし、発生力を検出するセンサーを取り付けることで装置コストがかかり、また、装置が大型化する。 There is an actuator control device that controls an actuator to cause a generated force of the actuator to follow a target generated force in order to move a driven body connected to the actuator with an intended force. If the actuator is a device that generates power by a rotating body such as a motor, the actuator control device controls the actuator so that the generated torque of the actuator follows the target generated torque. However, since the torque is proportional to the force, making the generated torque follow the target generated torque corresponds to making the generated force follow the target generated force. In order to realize this, the actuator control device feedback-controls the actuator based on the information of the sensor that detects the generated force. However, the installation of a sensor that detects the generated force increases the cost of the apparatus and increases the size of the apparatus.
そこで、アクチュエータの電流値を目標電流値に追従させるようアクチュエータをフィードバック制御することで、電流値に比例する発生力を目標発生力に追従させることができる。しかしながら、アクチュエータの経年劣化が発生すると、それが外乱となって両者の比例関係が崩れるため、発生力と目標発生力の間に誤差が生じる。 Therefore, by performing feedback control of the actuator so that the current value of the actuator follows the target current value, the generated force proportional to the current value can follow the target generated force. However, when the aging of the actuator occurs, it becomes a disturbance and the proportional relationship between the two is lost, and an error occurs between the generated force and the target generated force.
例えば、特許文献１では、アクチュエータに作用する外乱を補償する外乱オブザーバについての説明が行われている。アクチュエータの発生力を目標発生力に追従させる場合に、外乱オブザーバを適用すると、アクチュエータ制御装置は、以下のような処理を行う。
まず、アクチュエータ制御装置は、アクチュエータの電流信号を用いてアクチュエータの位置を推定する。次に、アクチュエータ制御装置は、アクチュエータの可動部の位置を外部センサーにより検出し、検出された位置信号と推定された位置信号との差を元に外乱を推定する。最後に、アクチュエータ制御装置は、外乱推定信号をアクチュエータの電流制御用の制御フィルタ部へ入力する。これにより、アクチュエータの経年劣化が発生しても、アクチュエータの発生力を目標発生力に追従させることができる。
For example,
First, the actuator control device estimates the position of the actuator using the current signal of the actuator. Next, the actuator control device detects the position of the movable part of the actuator with an external sensor, and estimates the disturbance based on the difference between the detected position signal and the estimated position signal. Finally, the actuator control device inputs the disturbance estimation signal to the control filter unit for current control of the actuator. Thereby, even if the aging of the actuator occurs, the generated force of the actuator can follow the target generated force.
しかしながら、従来の技術では、アクチュエータの可動部の位置検出センサーの検出分解能が低い場合、実際のアクチュエータの位置に対し量子化誤差が大きくなる。この量子化誤差が、外乱オブザーバにおける外乱の推定誤差につながり、制御が不安定となる。この結果、アクチュエータの発生力を目標発生力に追従させることができなくなる。 However, in the conventional technique, when the detection resolution of the position detection sensor of the movable part of the actuator is low, the quantization error becomes large with respect to the actual position of the actuator. This quantization error leads to a disturbance estimation error in the disturbance observer, and the control becomes unstable. As a result, the generated force of the actuator cannot follow the target generated force.
そこで、本発明の一又は複数の態様は、アクチュエータの可動部の位置を検出する検出部の検出分解能が低い場合でも、アクチュエータの発生力を目標発生力に追従させることができるようにすることを目的としている。 Therefore, one or a plurality of aspects of the present invention is to enable the generated force of the actuator to follow the target generated force even when the detection resolution of the detection unit that detects the position of the movable portion of the actuator is low. It is aimed.
本発明の一態様に係るアクチュエータ制御装置は、可動部を備えるアクチュエータを制御するアクチュエータ制御装置であって、検出された前記可動部の位置に誤差があるか否かの判定を行う判定部と、前記可動部を動作させるための動作電流から前記可動部の位置を推定し、前記検出された前記可動部の位置及び前記可動部の推定された位置を用いて、補正信号を出力する外乱オブザーバ部と、前記補正信号に基づいて前記アクチュエータを制御し、前記アクチュエータの発生力を前記アクチュエータの目標発生力に追従させる制御部と、を備え、前記外乱オブザーバ部は、前記判定の結果に応じて、前記補正信号を生成するための外乱補正ゲインを変更することを特徴とする。 An actuator control device according to an aspect of the present invention is an actuator control device that controls an actuator including a movable part, and determines whether or not there is an error in the position of the detected movable part; A disturbance observer unit that estimates a position of the movable unit from an operating current for operating the movable unit, and outputs a correction signal using the detected position of the movable unit and the estimated position of the movable unit And a control unit that controls the actuator based on the correction signal and causes the generated force of the actuator to follow the target generated force of the actuator, the disturbance observer unit according to the result of the determination, A disturbance correction gain for generating the correction signal is changed.
本発明の一態様に係るアクチュエータ制御方法は、可動部を備えるアクチュエータを制御するアクチュエータ制御方法であって、前記検出された前記可動部の位置に誤差があるか否かの判定を行い、前記可動部を動作させるための動作電流から前記可動部の位置を推定し、前記判定の結果に応じて外乱補正ゲインを変更した後に、前記検出された前記可動部の位置及び前記可動部の推定された位置を用いて補正信号を生成し、前記補正信号に基づいて前記アクチュエータを制御し、前記アクチュエータの発生力を前記アクチュエータの目標発生力に追従させることを特徴とする。 An actuator control method according to an aspect of the present invention is an actuator control method for controlling an actuator including a movable part, wherein it is determined whether or not there is an error in the detected position of the movable part, and the movable The position of the movable part is estimated from the operating current for operating the part, and the disturbance correction gain is changed according to the result of the determination, and then the detected position of the movable part and the movable part are estimated. A correction signal is generated using the position, the actuator is controlled based on the correction signal, and the generated force of the actuator is made to follow the target generated force of the actuator.
本発明の一又は複数の態様によれば、アクチュエータの可動部の位置を検出する検出部の検出分解能が低い場合でも、アクチュエータの発生力を目標発生力に追従させることができるようにすることを目的としている。 According to one or a plurality of aspects of the present invention, even if the detection resolution of the detection unit that detects the position of the movable part of the actuator is low, the generated force of the actuator can be made to follow the target generated force. It is aimed.
実施の形態１．
図１は、実施の形態１に係るアクチュエータ制御装置１の構成を概略的に示すブロック図である。
アクチュエータ制御装置１は、実施の形態１に係るアクチュエータ制御方法を実施することができる装置であり、アクチュエータ２の発生力を目標発生力に追従させる装置である。以降、アクチュエータ２がＤＣモータ（Ｄｉｒｅｃｔ−Ｃｕｒｒｅｎｔ Ｍｏｔｏｒ）の場合の動作を示す。この場合、アクチュエータ制御装置１は、発生トルクを目標発生トルクに追従させるよう、ＤＣモータを制御する。なお、実施の形態１におけるアクチュエータ２の発生力は、発生トルクとし、目標発生力は、目標発生トルクとするが、実施の形態１は、このような例に限定されるものではない。
FIG. 1 is a block diagram schematically showing the configuration of the
The
図１に示されるように、実施の形態１に係るアクチュエータ制御装置１は、信号出力部１１と、制御部１２と、判定部１３と、外乱オブザーバ部１４とを備える。
アクチュエータ制御装置１は、アクチュエータ２を制御し、検出部３でアクチュエータ２の可動部の位置を検出する。例えば、アクチュエータがＤＣモータの場合、可動部は、回転子である。
As shown in FIG. 1, the
The
アクチュエータ２は、磁気部２１、機構部２２及び後述の変換部２３を備える。また、検出部３は、アクチュエータ２の外部センサーとして、アクチュエータ２の可動部の位置を検出する。
The
信号出力部１１は、電流信号Ｓ１を制御部１２に与える。電流信号Ｓ１は、目標電流信号である。目標電流信号は、図示しない上位制御部から与えられる目標発生力信号である目標発生トルク信号Ｓ０に対し、変換係数を乗算して得られる。目標発生トルク信号Ｓ０は、アクチュエータ２で発生される力であるトルクを追従させる目標となるトルクを示すトルク信号である。この変換係数は、力信号としてのトルク信号を電流信号に変換する係数である。信号出力部１１は、目標発生トルク信号Ｓ０を演算して得られる目標電流信号である電流信号Ｓ１を制御部１２に与える。目標電流信号は、アクチュエータ２が目標発生力としての目標発生トルクで動作する時に発生する電流値を示す電流信号を想定している。
The signal output unit 11 provides the current signal S 1 to the
制御部１２は、信号出力部１１からの電流信号Ｓ１と、外乱オブザーバ部１４からの電流信号Ｓ２と、アクチュエータ２の磁気部２１からの電流信号Ｓ３を受け取る。制御部１２は、これらの信号に基づいて、アクチュエータ２を駆動するための駆動電圧を示す電圧信号Ｓ４をアクチュエータ２に与える。具体的には、制御部１２は、信号出力部１１からの電流信号Ｓ１で示される電流値を、外乱オブザーバ部１４からの電流信号Ｓ２で示される補正値により補正することで、アクチュエータ２への外乱を補償する。そして、制御部１２は、補正された値に、アクチュエータ２の磁気部２１からの電流信号Ｓ３が追従するように、アクチュエータ２を制御する。上述のように、信号出力部１１からの電流信号Ｓ１で示される電流値は、目標発生力に相当する。また、電流信号Ｓ１から電流信号Ｓ２を減算することは、アクチュエータ２への外乱を補償するように、発生力を補正することを示す。
The
アクチュエータ２の磁気部２１は、電圧信号Ｓ４に基づいて、機構部２２を駆動する。
検出部３は、アクチュエータ２の機構部２２において、可動部の位置を検出する。検出部３は、検出した位置を示す位置信号Ｓ５を、判定部１３及び外乱オブザーバ部１４に与える。
The
The detection unit 3 detects the position of the movable unit in the
判定部１３は、検出部３からの位置信号Ｓ５を受け取る。判定部１３は、この位置信号Ｓ５に基づいて、検出部３で検出される位置に誤差があるか否かを判定する。例えば、判定部１３は、検出部３からの位置信号Ｓ５で示される位置が更新されたか否かを確認する。判定部１３は、その位置が更新された場合には、検出部３で検出される位置に誤差がないと判定し、その位置が更新されていない場合には、検出部３で検出される位置に誤差があると判定する。判定部１３は、その判定結果を示す判定信号Ｓ６を外乱オブザーバ部１４に与える。判定信号Ｓ６は、「１」と「０」の二通りの値を取る。判定部１３での判定結果がＹＥＳの場合、判定信号Ｓ６は「１」を示し、判定結果がＮＯの場合、判定信号Ｓ６は「０」を示す。判定部１３の動作は、後に図５を用いて説明する。
Determining
外乱オブザーバ部１４は、アクチュエータ２の磁気部２１からの電流信号Ｓ３と、検出部３からの位置信号Ｓ５と、判定部１３からの判定信号Ｓ６とを受け取る。外乱オブザーバ部１４は、これらの信号に基づいて、アクチュエータ２への外乱を補償するための補正値を示す電流信号Ｓ２を制御部１２に与える。例えば、外乱オブザーバ部１４は、電流信号Ｓ３で示される動作電流の電流値により、アクチュエータ２の可動部の位置を推定する。そして、外乱オブザーバ部１４は、検出部３で検出された位置と推定された位置とを用いて、補正信号を出力する。具体的には、外乱オブザーバ部１４は、検出部３で検出された位置と推定された位置との差分を、誤差信号とする。外乱オブザーバ部１４は、誤差信号に外乱補正ゲインを乗算した乗算値を積分して、その積分された値を電流信号に変換することで、補正信号に相当する電流信号Ｓ２を生成する。なお、外乱オブザーバ部１４は、判定部１３での判定結果に応じて、外乱補正ゲインを変更する。補正信号は、アクチュエータ２の発生力を補正するための信号であり、外乱オブザーバ部１４により推定された外乱を補償するために用いられる電流信号である。補正信号は、検出部３で検出された可動部の位置及び外乱オブザーバ部１４で推定された位置を用いて算出される。外乱オブザーバ部１４は、アクチュエータ２の発生力を目標発生力に追従させるために、補正信号に相当する電流信号Ｓ２を出力する。外乱オブザーバ部１４の動作は、後に図３及び図４を用いて説明する。
The
制御部１２は、目標電流信号である電流信号Ｓ１と、推定された外乱を補償するための電流信号Ｓ２と、アクチュエータ２の動作電流に相当する電流値を示す電流信号Ｓ３とを用いて、アクチュエータ２を制御する。
The
図２は、実施の形態１に係るアクチュエータ制御装置１における制御部１２の構成を概略的に示すブロック図である。
図２に示されるように、制御部１２は、演算部１２１と、制御フィルタ部１２２とを備える。
FIG. 2 is a block diagram schematically showing the configuration of the
As shown in FIG. 2, the
演算部１２１は、信号出力部１１からの電流信号Ｓ１と、外乱オブザーバ部１４からの電流信号Ｓ２と、アクチュエータ２の磁気部２１からの電流信号Ｓ３とを受け取る。演算部１２１は、（Ｓ１−Ｓ２−Ｓ３）を算出し、この算出結果である電流信号Ｓ９を制御フィルタ部１２２に与える。
The
制御フィルタ部１２２は、演算部１２１からの電流信号Ｓ９を受け取る。制御フィルタ部１２２は、この電流信号Ｓ９に基づく電圧信号Ｓ４をアクチュエータ２の磁気部２１に与える。ここでは、制御フィルタ部１２２は、電流信号Ｓ９で示される差分に比例した比例制御を行うことで、アクチュエータ２の動作電流値を、目標値に近づける制御を行う。例えば、制御フィルタ部１２２は、ＰＩＤ（Ｐｒｏｐｏｒｔｉｏｎａｌ Ｉｎｔｅｇｒａｌ Ｄｅｒｉｖａｔｉｖｅ）制御フィルタを備えることができる。制御フィルタ部１２２は、このＰＩＤ制御フィルタによって電圧信号Ｓ４を生成してもよい。
The
図３は、実施の形態１のアクチュエータ２の構成を概略的に示すブロック図である。
図３に示されるように、アクチュエータ２は、磁気部２１と、機構部２２と、変換部２３とを備える。
磁気部２１は、減算部２１１及び変換部２１２を備える。
機構部２２は、変換部２２１、減算部２２２、変換部２２３、変換部２２４及び変換部２２４を備える。なお、図３では、機構部２２において、アクチュエータ２の可動部は図示されていない。
FIG. 3 is a block diagram schematically showing the configuration of the
As shown in FIG. 3, the
The
The
減算部２１１は、制御フィルタ部１２２からの電圧信号Ｓ４と、変換部２３からの電圧信号Ｓ７とを受け取る。減算部２１１は、（Ｓ４−Ｓ７）を算出し、この算出結果である電圧信号Ｓ１４を変換部２１２に与える。
変換部２１２は、減算部２１１からの電圧信号Ｓ１４を受け取る。変換部２１２は、この電圧信号Ｓ１４に基づく電流信号Ｓ３を機構部２２の変換部２２１に与える。変換部２１２の伝達関数は、コイル抵抗ＲとコイルインダクタンスＬとを用いて表すと、１／（Ｌｓ＋Ｒ）である。なお、ｓはラプラス変数であり、以降も同様とする。
The subtracting
変換部２２１は、変換部２１２からの電流信号Ｓ３を受け取る。変換部２２１は、この電流信号Ｓ３に基づくトルク信号Ｓ１５を減算部２２２に与える。変換部２２１の伝達関数は、電流信号をトルク信号に変換する変換係数Ｋｔである。
減算部２２２は、変換部２２１からのトルク信号Ｓ１５と、変換部２２４からのトルク信号Ｓ１６を受け取る。減算部２２２は、（Ｓ１５−Ｓ１６）を算出し、この算出結果であるトルク信号Ｓ１７を変換部２２３に与える。トルク信号Ｓ１７は、アクチュエータ２であるＤＣモータの発生トルクに相当する。
The
変換部２２３は、減算部２２２からのトルク信号Ｓ１７を受け取る。変換部２２３は、このトルク信号Ｓ１７に基づく速度信号Ｓ１８を変換部２２４に与える。変換部２２３の伝達関数は、イナーシャＪと粘性係数Ｄとを用いて表すと、１／（Ｊｓ＋Ｄ）である。
変換部２２４は、変換部２２３からの速度信号Ｓ１８を受け取る。変換部２２４は、この速度信号Ｓ１８に基づくトルク信号Ｓ１６を出力する。変換部２２４の伝達関数は、摩擦係数τｃである。トルク信号Ｓ１６は、アクチュエータ２の経年劣化により発生する。これが外乱としてアクチュエータ２に作用する。
変換部２２５は、変換部２２３からの速度信号Ｓ１８を受け取る。変換部２２５は、この速度信号Ｓ１８に基づく位置信号Ｓ８を検出部３に与える。変換部２２５の伝達関数は、１／ｓである。
変換部２３は、変換部２２３から速度信号Ｓ１８を受け取る。変換部２３は、この速度信号Ｓ１８に基づく電圧信号Ｓ７を減算部２１１に与える。変換部２３の伝達関数は、逆起電力係数Ｋｅである。
図１に戻り、検出部３は、機構部２２からの位置信号Ｓ８を受け取る。検出部３は、位置信号Ｓ８に基づいて、機構部２２において、アクチュエータ２の可動部の位置を検出して、検出された位置を示す位置信号Ｓ５を外乱オブザーバ部１４及び判定部１３に与える。
Returning to FIG. 1, the detection unit 3 receives the position signal S 8 from the
図４は、実施の形態１において、機構部２２で生成される位置信号Ｓ８と、検出部３で検出される位置に相当する位置信号Ｓ５の一例を示す図である。言い換えると、図４は、実際のアクチュエータ２の位置を示す位置信号Ｓ８と、検出部３の検出分解能の制約で量子化誤差が発生した位置を示す位置信号Ｓ５とを示す図である。
Figure 4 is the first embodiment and is a diagram showing a position signal S 8 generated by the
図４において、点線は、位置信号Ｓ８で示される位置の推移である。実線は、位置信号Ｓ５で示される位置の推移である。
図４に示されるように、位置信号Ｓ５で示される位置は、アクチュエータ２の位置を検出するタイミング、言い換えると、アクチュエータ２の位置情報を更新するタイミング以外のタイミングでは、位置信号Ｓ８で示される位置との誤差が発生する。位置信号Ｓ５は、外乱オブザーバ部１４で使用され、この誤差が外乱オブザーバ部１４の動作に悪影響を及ぼす。
4, the dotted line is the transition of the position indicated by the position signal S 8. The solid line is the transition of the position indicated by the position signal S 5.
As shown in FIG. 4, the position indicated by the position signal S 5, the timing for detecting the position of the
そこで、図１に示されている判定部１３は、検出部３からの位置信号Ｓ５が更新されたか否かを確認する。例えば、判定部１３は、検出部３が位置を検出する周期よりも短い周期で、検出部３により検出された位置が更新されているか否かを確認する。
具体的には、判定部１３は、アクチュエータ２を制御する最小のサンプリング周期毎に位置信号Ｓ５の値を取得し、現サンプリングにおける位置信号Ｓ５の値と１つ前のサンプリングにおける位置信号Ｓ５の値とが異なるかどうかを確認する。判定部１３は、これらの２つの値が異なる場合は、更新されたとみなし、同じ場合は、更新されていないとみなす。更新された場合、判定部１３は、判定結果をＹＥＳとし、判定信号Ｓ６を「１」を示すようにする。更新されていない場合、判定部１３は、判定結果をＮＯとし、判定信号Ｓ６を「０」を示すようにする。判定結果と判定信号Ｓ６とを設定するタイミングは、現サンプリングにおける位置信号Ｓ５の値と、１つ前のサンプリングにおける位置信号Ｓ５の値とが異なるかどうかを判定した直後とする。
Therefore, the
Specifically, the
図５は、実施の形態１に係るアクチュエータ制御装置１における外乱オブザーバ部１４の構成を概略的に示すブロック図である。具体的には、アクチュエータ２の発生力を目標発生力に追従させるための補正信号を生成する外乱オブザーバ部１４のブロック図である。
なお、外乱オブザーバ部１４は、アクチュエータ２の特性を模擬するモデル機構を用いることで、アクチュエータ２の可動部の位置を推定する。
図５に示されるように、外乱オブザーバ部１４は、モデル機構部１４１と、減算部１４２と、ゲイン変更部１４３と、積分器１４４と、モデル変換部１４５とを備える。
FIG. 5 is a block diagram schematically showing the configuration of the
The
As shown in FIG. 5, the
モデル機構部１４１は、アクチュエータ２の磁気部２１から電流信号Ｓ３と、ゲイン変更部１４３から補正誤差信号Ｓ１１＿１、Ｓ１１＿２、・・・、Ｓ１１＿ｍ（但し、ｍ＝ｎ−１、ｎは、２以上の自然数）と、積分器１４４からの力信号としてのトルク信号Ｓ１２とを受け取る。ここで、モデル機構部１４１は、これらの信号に基づいて推定位置信号Ｓ１０を出力する。
モデル機構部１４１は、アクチュエータ２の機構部２２の理想的な伝達特性を模擬したモデル伝達特性を持ち、電流信号Ｓ３から発生力を推定し、推定位置信号Ｓ１０を減算部１４２に与える。言い換えると、モデル機構部１４１は、アクチュエータ２の特定を模擬するモデル機構として機能する。また、ｎの値は、モデル機構部１４１の構成によって変わる。推定位置信号Ｓ１０は、機構部２２における駆動する部分の理想的な推定位置を示す信号である。
The
減算部１４２は、検出部３からの位置信号Ｓ５と、モデル機構部１４１からの推定位置信号Ｓ１０とを受け取る。減算部１４２は、（Ｓ５−Ｓ１０）を算出し、この算出結果である誤差信号Ｓ１１をゲイン変更部１４３に与える。言い換えると、減算部１４２は、モデル機構部１４１で推定された推定位置と、検出部３で検出された位置との差分を示す誤差信号Ｓ１１をゲイン変更部１４３に与える。
The
ゲイン変更部１４３は、減算部１４２からの誤差信号Ｓ１１と、判定部１３からの判定信号Ｓ６とを受け取る。ゲイン変更部１４３は、これらの信号に基づく補正誤差信号Ｓ１１＿１、Ｓ１１＿２、・・・、Ｓ１１＿ｎをモデル機構部１４１及び積分器１４４に与える。
ゲイン変更部１４３は、判定部１３からの判定信号Ｓ６に基づいて、電流信号Ｓ２を生成する際の補正係数、すなわち外乱オブザーバ部１４の外乱補正ゲインＫ１、Ｋ２、・・・、Ｋｎを変更する。外乱補正ゲインＫ１、Ｋ２、・・・、Ｋｎは、全て０以上の正の値である。具体的には、ゲイン変更部１４３は、判定信号Ｓ６が「１」を示す場合には、ゲインを正の値に設定し、判定信号Ｓ６が「０」の場合は、判定信号Ｓ６が「１」の場合よりもゲインを小さくする。例えば、ゲイン変更部１４３は、判定信号Ｓ６が「０」の場合は、ゲインを「０」にする。
The
The
また、ゲインＫ１、Ｋ２、・・・、Ｋｎを変更するタイミングは、判定部１３が判定結果と判定信号Ｓ６を設定した直後とする。または、判定部１３が判定してから、ゲイン変更部１４３がゲインＫ１、Ｋ２、・・・、Ｋｎを変更するまでの時間をＮサンプリングに相当する時間としてもよい。但し、Ｎは、Ｌ＿ｍｉｎ／ｔｓより小さい任意の整数値である。ここで、Ｌ＿ｍｉｎは、アクチュエータ２の制御開始から終了までのうち、位置信号Ｓ５が更新されてから次に更新されるまでの時間Ｌの最小値であり、ｔｓは、サンプリング周期である。
時間Ｌが小さいほど、位置信号Ｓ８と位置信号Ｓ５との誤差は小さくなる。この場合、位置信号Ｓ５の更新タイミングから遅れてゲインＫ１、Ｋ２、・・・、Ｋｎを変更しても、誤差が小さいため、外乱オブザーバ部１４の動作への悪影響を小さくできる。なお、時間Ｌの最小値Ｌ＿ｍｉｎは、判定部１３により予め取得される。具体的には、判定部１３は、サンプリング毎に時間Ｌを取得し、最小値をＬ＿ｍｉｎに設定する。
The gain K 1, K 2, · · ·, timing of changing the K n is immediately after the
Time as L is smaller, an error between the position signal S 5 and the position signal S 8 becomes small. In this case, even if the gains K 1 , K 2 ,..., Kn are changed with a delay from the update timing of the position signal S 5 , since the error is small, the adverse effect on the operation of the
積分器１４４は、ゲイン変更部１４３からの補正誤差信号Ｓ１１＿ｎを受け取る。積分器１４４は、この補正誤差信号Ｓ１１＿ｎに基づくトルク信号Ｓ１２をモデル変換部１４５及びモデル機構部１４１に与える。積分器１４４の伝達関数は、１／ｓである。
The
モデル変換部１４５は、積分器１４４からトルク信号Ｓ１２を受け取る。モデル変換部１４５は、このトルク信号Ｓ１２に基づく電流信号Ｓ２を出力する。モデル変換部１４５の伝達関数は、電流信号をトルク信号に変換する変換係数Ｋｔの推定値Ｋｔｍを用いて表すと、１／Ｋｔｍである。
以上のように、外乱オブザーバ部１４は、位置信号Ｓ５と推定位置信号Ｓ１０との差である誤差信号Ｓ１１をゲインＫ１、Ｋ２、・・・、Ｋｎで乗じて、その乗算値に相当する補正誤差信号Ｓ１１＿１、Ｓ１１＿２、・・・、Ｓ１１＿ｎの内、補正誤差信号Ｓ１１＿１、Ｓ１１＿２、・・・、Ｓ１１＿ｍをモデル機構部１４１に与え、補正誤差信号Ｓ１１＿ｎを積分器１４４に与える。モデル変換部１４５を通るトルク信号Ｓ１２は、電流信号Ｓ２に変換されて制御部１２に与えられる。これにより、アクチュエータ２に作用する外乱が補償され、発生トルクを目標発生トルクに追従させることができる。
As described above, the
図６は、実施の形態１に係るアクチュエータ制御装置１におけるモデル機構部１４１の構成を概略的に示すブロック図である。
図６に示されるように、モデル機構部１４１は、モデル変換部１４１１と、モデル演算部１４１２と、モデル変換部１４１３と、モデル加算部１４１４と、モデル変換部１４１５と、モデル変換部１４１６と、モデル加算部１４１７と、モデル変換部１４１８とを備える。
FIG. 6 is a block diagram schematically showing the configuration of the
As shown in FIG. 6, the
モデル変換部１４１１は、アクチュエータ２の磁気部２１からの電流信号Ｓ３を受け取る。モデル変換部１４１１は、この電流信号Ｓ３に基づく推定トルク信号Ｓ１９をモデル演算部１４１２に与える。モデル変換部１４１１の伝達関数は、電流信号をトルク信号に変換する変換係数Ｋｔの推定値Ｋｔｍである。
The
モデル演算部１４１２は、モデル変換部１４１１からの推定トルク信号Ｓ１９と、モデル変換部１４１６からの推定トルク信号Ｓ２０と、積分器１４４からのトルク信号Ｓ１２とを受け取る。モデル演算部１４１２は、（Ｓ１９−Ｓ２０＋Ｓ１２）を算出し、この算出結果である推定トルク信号Ｓ２１をモデル変換部１４１３に与える。
The
モデル変換部１４１３は、モデル演算部１４１２からの推定トルク信号Ｓ２１を受け取る。モデル変換部１４１３は、この推定トルク信号Ｓ２１に基づく推定加速度信号Ｓ２２をモデル加算部１４１４に与える。モデル変換部１４１３の伝達関数は、推定イナーシャＪｍを用いて表すと、１／Ｊｍである。推定イナーシャＪｍは、イナーシャＪの推定値であり、ここでは、両者は一致すると仮定する。
モデル加算部１４１４は、モデル変換部１４１３からの推定加速度信号Ｓ２２と、ゲイン変更部１４３からの補正誤差信号Ｓ１１＿２を受け取る。モデル加算部１４１４は、（Ｓ２２＋Ｓ１１＿２）を算出し、この算出結果である推定加速度信号Ｓ２３をモデル変換部１４１５に与える。
モデル変換部１４１５は、モデル加算部１４１４からの推定加速度信号Ｓ２３を受け取る。モデル変換部１４１５は、この推定加速度信号Ｓ２３に基づく推定速度信号Ｓ２４をモデル変換部１４１６及びモデル加算部１４１７に与える。モデル変換部１４１５の伝達関数は、１／ｓである。
モデル変換部１４１６は、モデル変換部１４１５からの推定速度信号Ｓ２４を受け取る。モデル変換部１４１６は、この推定速度信号Ｓ２４に基づく推定トルク信号Ｓ２０をモデル演算部１４１２に与える。モデル変換部１４１６の伝達関数は、推定粘性係数Ｄｍである。推定粘性係数Ｄｍは、粘性係数Ｄの推定値であり、ここでは、両者は一致すると仮定する。
The
モデル加算部１４１７は、モデル変換部１４１５からの推定速度信号Ｓ２４と、ゲイン変更部１４３からの補正誤差信号Ｓ１１＿１を受け取る。モデル加算部１４１７は、（Ｓ２４＋Ｓ１１＿１）を算出し、この算出結果である推定速度信号Ｓ２５をモデル変換部１４１８に与える。
The
モデル変換部１４１８は、モデル加算部１４１７からの推定速度信号Ｓ２５を受け取る。モデル変換部１４１８は、この推定速度信号Ｓ２５に基づく推定位置信号Ｓ１０を減算部１４２に与える。モデル変換部１４１８の伝達関数は、１／ｓである。
The
図６に示されているモデル機構部１４１では、電流信号Ｓ２を生成する際の補正係数に相当するゲインは、３つのゲインＫ１、Ｋ２及びＫ３であり、ゲイン変更部１４３では、誤差信号Ｓ１１をゲインＫ１、Ｋ２及びＫ３で乗じ、それぞれ補正誤差信号Ｓ１１＿１、Ｓ１１＿２及びＳ１１＿３を生成する。このうち、補正誤差信号Ｓ１１＿１及びＳ１１＿２は、そのままモデル機構部１４１に与えられ、補正誤差信号Ｓ１１＿３は、積分器１４４に与えられる。積分器１４４から出力されるトルク信号Ｓ１２は、モデル機構部１４１及びモデル変換部１４５に入力される。
In the
以上に記載された信号出力部１１、制御部１２、外乱オブザーバ部１４及び判定部１３の一部又は全部は、例えば、図７（ａ）に示されているように、メモリ３０と、メモリ３０に格納されているプログラムを実行するＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）等のプロセッサ３１とにより構成することができる。このようなプログラムは、ネットワークを通じて提供されてもよく、また、記録媒体に記録されて提供されてもよい。即ち、このようなプログラムは、例えば、プログラムプロダクトとして提供されてもよい。
A part or all of the signal output unit 11, the
また、信号出力部１１、制御部１２、外乱オブザーバ部１４及び判定部１３の一部又は全部は、例えば、図７（ｂ）に示されているように、単一回路、複合回路、プログラム化したプロセッサ、並列プログラム化したプロセッサ、ＡＳＩＣ（Ａｐｐｌｉｃａｔｉｏｎ Ｓｐｅｃｉｆｉｃ Ｉｎｔｅｇｒａｔｅｄ Ｃｉｒｃｕｉｔｓ）又はＦＰＧＡ（Ｆｉｅｌｄ Ｐｒｏｇｒａｍｍａｂｌｅ Ｇａｔｅ Ａｒｒａｙ）等の処理回路３２で構成することもできる。
Further, a part or all of the signal output unit 11, the
図８（ａ）〜（ｄ）は、比較例におけるアクチュエータ２のパルス応答を示す図である。図８（ａ）〜（ｄ）は、実施の形態１におけるアクチュエータ制御装置１において、判定部１３を設けずに、外乱オブザーバ部１４が、ゲインとして正の値を使用し、ゲインの変更を行わない場合を示している。
8A to 8D are diagrams showing the pulse response of the
図８（ａ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えたときの目標発生トルク信号Ｓ０の変化が示されている。縦軸は、目標発生トルク信号Ｓ０（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 8A, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). Nm), and the change in the target generated torque signal S 0 when the value is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 11 seconds has elapsed. The vertical axis represents the target generated torque signal S 0 (Nm), and the horizontal axis represents time (sec).
図８（ｂ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時のトルク信号Ｓ１７のパルス応答が示されている。縦軸は、トルク信号Ｓ１７（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 8B, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the torque signal S 17 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the torque signal S 17 (Nm), and the horizontal axis represents time (sec).
図８（ｃ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の電流信号Ｓ３のパルス応答が示されている。縦軸は、電流信号Ｓ３（Ａ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 8C, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), the pulse response of the current signal S 3 when changing the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm) is shown. The vertical axis represents the current signal S 3 (A), and the horizontal axis represents time (sec).
図８（ｄ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の誤差信号Ｓ１１のパルス応答が示されている。縦軸は、誤差信号Ｓ１１（ｒａｄ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 8D, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the error signal S 11 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the error signal S 11 (rad), and the horizontal axis represents time (sec).
図８（ｂ）に示されるように、トルク信号Ｓ１７は、１秒経過後に発振し、目標発生トルク信号Ｓ０に追従できていない。また、図８（ｃ）及び（ｄ）に示されるように、電流信号Ｓ３も発振し、誤差信号Ｓ１１は大きくなる。 As shown in FIG. 8 (b), the torque signal S 17 oscillates after lapse of one second, not to follow the target generated torque signal S 0. Further, as shown in FIG. 8 (c) and (d), also oscillating current signal S 3, the error signal S 11 is increased.
図９（ａ）〜（ｄ）は、実施の形態１におけるアクチュエータ２の第１のパルス応答を示す図である。図９（ａ）〜（ｄ）は、位置信号Ｓ５が更新された場合はゲインＫ１、Ｋ２及びＫ３を正の値に設定し、位置信号Ｓ５が更新されていない場合はゲインＫ１、Ｋ２及びＫ３を全て０としたときのパルス応答を示す。
FIGS. 9A to 9D are diagrams showing a first pulse response of the
図９（ａ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の目標発生トルク信号Ｓ０の変化が示されている。縦軸は、目標発生トルク信号Ｓ０（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 9A, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). Nm), and a change in the target generated torque signal S 0 when 11 (second) is changed from 0 (Nm) to 2 × 10 −4 (Nm) is shown. The vertical axis represents the target generated torque signal S 0 (Nm), and the horizontal axis represents time (sec).
図９（ｂ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時のトルク信号Ｓ１７のパルス応答が示されている。縦軸は、トルク信号Ｓ１７（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 9B, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the torque signal S 17 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the torque signal S 17 (Nm), and the horizontal axis represents time (sec).
図９（ｃ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の電流信号Ｓ３のパルス応答が示されている。縦軸は、電流信号Ｓ３（Ａ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 9C, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), the pulse response of the current signal S 3 when changing the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm) is shown. The vertical axis represents the current signal S 3 (A), and the horizontal axis represents time (sec).
図９（ｄ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の誤差信号Ｓ１１のパルス応答が示されている。縦軸は、誤差信号Ｓ１１（ｒａｄ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 9D, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the error signal S 11 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the error signal S 11 (rad), and the horizontal axis represents time (sec).
図９（ｂ）〜（ｄ）に示されるように、誤差信号Ｓ１１が大きくなった場合でも、電流信号Ｓ３は発振せず、トルク信号Ｓ１７は目標発生トルク信号Ｓ０に追従できている。 As shown in FIG. 9 (b) ~ (d) , even if the error signal S 11 is increased, the current signal S 3 is not oscillated, the torque signal S 17 is able to follow the target generated torque signal S 0 Yes.
なお、ゲインＫ１、Ｋ２及びＫ３の値が大きい場合、位置信号Ｓ５が更新されていない場合にゲインＫ１、Ｋ２及びＫ３を変更しても、トルク信号Ｓ１７を目標発生トルク信号Ｓ０に追従させることができない場合がある。この対策として、判定部１３は、電流信号Ｓ３が予め定められた値以内かどうかを更に判定する。これは、図８（ｃ）に示されるように、トルク信号Ｓ１７が目標発生トルク信号Ｓ０に追従できずに発振する場合、電流信号Ｓ３も発振するためである。上記判定により、発振する前に外乱オブザーバ部１４の動作を弱く、例えば、外乱オブザーバ部１４の動作を無効にして、発振するのを防止することができる。そこで、判定部１３では、位置信号Ｓ５が更新されたかどうかを判定し、かつ電流信号Ｓ３が予め定められた値以内かどうかを判定する。この場合、判定部１３に入力される信号は、検出部３からの位置信号Ｓ５と、磁気部２１からの電流信号Ｓ３である。判定部１３では、この２つの判定結果が共にＹＥＳの場合はゲインＫ１、Ｋ２及びＫ３を正の値に設定し、２つの判定結果のうち少なくとも１つがＮＯの場合は、ゲインＫ１、Ｋ２及びＫ３を２つの判定結果が共にＹＥＳの場合よりも小さくする。
When the values of the gains K 1 , K 2, and K 3 are large, the torque signal S 17 is generated even if the gains K 1 , K 2, and K 3 are changed when the position signal S 5 is not updated. it may not be possible to follow the torque signal S 0. As a countermeasure, the
図１０（ａ）〜（ｄ）は、実施の形態１におけるアクチュエータ２の第２のパルス応答を示す図である。図１０（ａ）〜（ｄ）は、位置信号Ｓ５が更新されたかどうかが判定され、かつ、電流信号Ｓ３が予め定められた値以内かどうかが判定され、この２つの判定結果が共にＹＥＳの場合に、ゲインＫ１、Ｋ２及びＫ３が正の値に設定され、２つの判定結果のうち少なくとも１つがＮＯの場合に、ゲインＫ１、Ｋ２及びＫ３が全て０とされたときのパルス応答を示す。
10A to 10D are diagrams showing a second pulse response of the
図１０（ａ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の目標発生トルク信号Ｓ０の変化が示されている。縦軸は、目標発生トルク信号Ｓ０（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 10A, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). Nm), and a change in the target generated torque signal S 0 when 11 (second) is changed from 0 (Nm) to 2 × 10 −4 (Nm) is shown. The vertical axis represents the target generated torque signal S 0 (Nm), and the horizontal axis represents time (sec).
図１０（ｂ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時のトルク信号Ｓ１７のパルス応答が示されている。縦軸は、トルク信号Ｓ１７（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 10B, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the torque signal S 17 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the torque signal S 17 (Nm), and the horizontal axis represents time (sec).
図１０（ｃ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の電流信号Ｓ３のパルス応答が示されている。縦軸は、電流信号Ｓ３（Ａ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 10C, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), the pulse response of the current signal S 3 when changing the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm) is shown. The vertical axis represents the current signal S 3 (A), and the horizontal axis represents time (sec).
図１０（ｄ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の誤差信号Ｓ１１のパルス応答が示されている。縦軸は、誤差信号Ｓ１１（ｒａｄ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 10D, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the error signal S 11 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the error signal S 11 (rad), and the horizontal axis represents time (sec).
図１０（ｂ）〜（ｄ）に示されるように、誤差信号Ｓ１１が大きくなった場合でも、電流信号Ｓ３は発振せず、トルク信号Ｓ１７は目標発生トルク信号Ｓ０に追従できている。 As shown in FIG. 10 (b) ~ (d) , even if the error signal S 11 is increased, the current signal S 3 is not oscillated, the torque signal S 17 is able to follow the target generated torque signal S 0 Yes.
なお、判定部１３は、電流信号Ｓ３が予め定められた値以内かどうかを判定する代わりに、誤差信号Ｓ１１が予め定められた値以内かどうかを判定してもよい。これは、図８（ｄ）に示されるように、トルク信号Ｓ１７が目標発生トルク信号Ｓ０に追従できずに発振する場合、誤差信号Ｓ１１が大きくなるためである。上記判定により、誤差信号Ｓ１１が大きくなる前に外乱オブザーバ部１４の動作を弱く、例えば、無効にして、発振するのを防止することができる。そこで、判定部１３は、位置信号Ｓ５が更新されたかどうかを判定し、かつ誤差信号Ｓ１１が予め定められた値以内かどうかを判定する。この場合、判定部１３に入力される信号は、検出部３からの位置信号Ｓ５と、減算部１４２からの誤差信号Ｓ１１である。判定部１３では、この２つの判定結果が共にＹＥＳの場合はゲインＫ１、Ｋ２及びＫ３を正の値に設定し、２つの判定結果のうち少なくとも１つがＮＯの場合は、ゲインＫ１、Ｋ２及びＫ３を２つの判定結果が共にＹＥＳの場合よりも小さくする。
The
図１１（ａ）〜（ｄ）は、実施の形態１におけるアクチュエータ２の第３のパルス応答を示す図である。図１１（ａ）〜（ｄ）は、位置信号Ｓ５が更新されたかどうかが判定され、かつ、誤差信号Ｓ１１が予め定められた値以内かどうかが判定され、この２つの判定結果が共にＹＥＳの場合に、ゲインＫ１、Ｋ２及びＫ３が正の値に設定され、２つの判定結果のうち少なくとも１つがＮＯの場合に、ゲインＫ１、Ｋ２及びＫ３が全て０とされたときのパルス応答を示す。
11A to 11D are diagrams showing a third pulse response of the
図１１（ａ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の目標発生トルク信号Ｓ０の変化が示されている。縦軸は、目標発生トルク信号Ｓ０（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 11A, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). Nm), and a change in the target generated torque signal S 0 when 11 (second) is changed from 0 (Nm) to 2 × 10 −4 (Nm) is shown. The vertical axis represents the target generated torque signal S 0 (Nm), and the horizontal axis represents time (sec).
図１１（ｂ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時のトルク信号Ｓ１７のパルス応答が示されている。縦軸は、トルク信号Ｓ１７（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 11B, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the torque signal S 17 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the torque signal S 17 (Nm), and the horizontal axis represents time (sec).
図１１（ｃ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の電流信号Ｓ３のパルス応答が示されている。縦軸は、電流信号Ｓ３（Ａ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 11 (c), the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), the pulse response of the current signal S 3 when changing the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm) is shown. The vertical axis represents the current signal S 3 (A), and the horizontal axis represents time (sec).
図１１（ｄ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の誤差信号Ｓ１１のパルス応答が示されている。縦軸は、誤差信号Ｓ１１（ｒａｄ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 11D, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the error signal S 11 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the error signal S 11 (rad), and the horizontal axis represents time (sec).
図１１（ｂ）〜（ｄ）に示されるように、誤差信号Ｓ１１が大きくなった場合でも、電流信号Ｓ３は発振せず、トルク信号Ｓ１７は目標発生トルク信号Ｓ０に追従できている。 As shown in FIG. 11 (b) ~ (d) , even if the error signal S 11 is increased, the current signal S 3 is not oscillated, the torque signal S 17 is able to follow the target generated torque signal S 0 Yes.
なお、判定部１３では、位置信号Ｓ５が更新されたかどうかを判定し、かつ電流信号Ｓ３が予め定められた値以内かどうかを判定し、かつ誤差信号Ｓ１１が予め定められた値以内かどうかを判定してもよい。この場合、判定部１３に入力される信号は、検出部３からの位置信号Ｓ５と、磁気部２１からの電流信号Ｓ３と、減算部１４２からの誤差信号Ｓ１１である。判定部１３では、この３つの判定結果が共にＹＥＳの場合はゲインＫ１、Ｋ２及びＫ３を正の値に設定し、３つの判定結果のうち少なくとも１つがＮＯの場合は、ゲインＫ１、Ｋ２及びＫ３を３つの判定結果が共にＹＥＳの場合よりも小さくする。
In the
図１２（ａ）〜（ｄ）は、実施の形態１におけるアクチュエータ２の第４のパルス応答を示す図である。図１２（ａ）〜（ｄ）は、位置信号Ｓ５が更新されたかどうかが判定され、電流信号Ｓ３が予め定められた値以内かどうかが判定され、かつ、誤差信号Ｓ１１が予め定められた値以内かどうかが判定され、この３つの判定結果が共にＹＥＳの場合に、ゲインＫ１、Ｋ２及びＫ３が正の値に設定され、３つの判定結果のうち少なくとも１つがＮＯの場合に、ゲインＫ１、Ｋ２及びＫ３が全て０とされたときのパルス応答を示す。
FIGS. 12A to 12D are diagrams showing a fourth pulse response of the
図１２（ａ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の目標発生トルク信号Ｓ０の変化が示されている。縦軸は、目標発生トルク信号Ｓ０（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 12A, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). Nm), and a change in the target generated torque signal S 0 when 11 (second) is changed from 0 (Nm) to 2 × 10 −4 (Nm) is shown. The vertical axis represents the target generated torque signal S 0 (Nm), and the horizontal axis represents time (sec).
図１２（ｂ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時のトルク信号Ｓ１７のパルス応答が示されている。縦軸は、トルク信号Ｓ１７（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 12B, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the torque signal S 17 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the torque signal S 17 (Nm), and the horizontal axis represents time (sec).
図１２（ｃ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の電流信号Ｓ３のパルス応答が示されている。縦軸は、電流信号Ｓ３（Ａ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 12C, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), the pulse response of the current signal S 3 when changing the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm) is shown. The vertical axis represents the current signal S 3 (A), and the horizontal axis represents time (sec).
図１２（ｄ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の誤差信号Ｓ１１のパルス応答が示されている。縦軸は、誤差信号Ｓ１１（ｒａｄ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 12D, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), it is shown pulse response of the error signal S 11 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the error signal S 11 (rad), and the horizontal axis represents time (sec).
図１２（ｂ）〜（ｄ）に示されるように、誤差信号Ｓ１１が大きくなった場合でも、電流信号Ｓ３は発振せず、トルク信号Ｓ１７は目標発生トルク信号Ｓ０に追従できている。 As shown in FIG. 12 (b) ~ (d) , even if the error signal S 11 is increased, the current signal S 3 is not oscillated, the torque signal S 17 is able to follow the target generated torque signal S 0 Yes.
図８（ｃ）及び（ｄ）に示されるように、１秒経過後の電流信号Ｓ３と誤差信号Ｓ１１は大きくなる。このため、電流信号Ｓ３が予め定められた値以内かどうか、又は、誤差信号Ｓ１１が予め定められた値以内かどうかを判定条件に含めた場合、１秒経過後は常に判定部１３の判定結果がＮＯとなることがあり、ゲインＫ１、Ｋ２及びＫ３は０にされる。しかし、この場合でも積分器１４４の出力信号であるトルク信号Ｓ１２は、ゲインＫ１、Ｋ２及びＫ３が０となる前の値が保持される。電流信号Ｓ２はトルク信号Ｓ１２に比例するため、制御部１２へは常に一定の電流信号Ｓ２が入力されることとなる。図８（ｂ）に示されるように、１秒経過時のトルク信号Ｓ１７の値は、目標発生トルク信号Ｓ０の値と同じ２×１０−４（Ｎｍ）のため、１秒経過後でもトルク信号Ｓ１７の値を２×１０−４（Ｎｍ）に維持することができる。
As shown in FIG. 8 (c) and (d), the current signal S 3 after a lapse of one second and the error signal S 11 is increased. Therefore, whether within the value the current signal S 3 with a predetermined or when whether within the value error signal S 11 is a predetermined included in the determination conditions, always
特に、電流信号Ｓ３が予め定められた値を超えた場合は、アクチュエータ制御装置１を緊急停止させるのが一般的だが、実施の形態１では、電流信号Ｓ３が予め定められた値を超えた場合に、ゲインＫ１、Ｋ２及びＫ３が小さくされるため、それを緊急停止させる必要がなく、トルク信号Ｓ１７を目標発生トルク信号Ｓ０に追従させることができる。
In particular, when it exceeds the value that the current signal S 3 predetermined but general that an emergency
なお、図６〜図１２は、アクチュエータ２がＤＣモータで、ＤＣモータの発生トルクを目標発生トルクに追従させる場合の図であるが、アクチュエータ２がＤＣモータ以外であっても、実施の形態１を適用することができる。また、アクチュエータ２の発生力を目標発生力に追従させる場合でも、実施の形態１を適用することができる。
6 to 12 are diagrams in the case where the
以上に説明したように、実施の形態１に係るアクチュエータ制御装置１及びアクチュエータ位置制御方法によれば、判定部１３の判定結果がＹＥＳの場合は外乱オブザーバ部１４の外乱補正ゲインを正の値に設定し、ＮＯの場合は判定結果がＹＥＳの場合よりもゲインを小さくすることで、アクチュエータ２の位置検出センサーの精度が低い場合でも、発振することなくアクチュエータ２の発生力を目標発生力に追従させることができる。また、判定結果がＮＯの場合が継続しても、積分器１３４により、外乱補正ゲインが０となる前の信号が制御部１２に入力され続けるので、アクチュエータ２の発生力を目標発生力に追従させることができる。
As described above, according to the
これまで述べたアクチュエータ制御装置１では、アクチュエータ２がＤＣモータの場合で、機構部２２のパラメータと、モデル機構部１３６の推定パラメータとが一致すると仮定した。ここで、機構部２２のパラメータは、例えば、電流信号をトルク信号に変換する変換係数Ｋｔ、イナーシャＪ及び粘性係数Ｄである。モデル機構部１３６の推定パラメータは、電流信号をトルク信号に変換する変換係数の推定値Ｋｔｍ、イナーシャの推定値Ｊｍ及び推定粘性係数の推定値Ｄｍである。すなわち、Ｋｔ＝Ｋｔｍ、Ｊ＝Ｊｍ及びＤ＝Ｄｍと仮定した。実際には、アクチュエータ２に接続される被駆動体の負荷イナーシャを考慮すると、イナーシャの推定値ＪｍをイナーシャＪと一致させるのは困難である。そこで、以降は機構部２２のパラメータとモデル機構部１４１の推定パラメータとが一致しない場合、具体的にはイナーシャＪとイナーシャの推定値Ｊｍとが一致しない場合のアクチュエータ制御方法について説明する。
In the
図１３は、実施の形態１に係るアクチュエータ制御装置１の変形例であるモデル機構部１４１＃の構成を概略的に示すブロック図である。
図１３に示されるように、モデル機構部１４１は、モデル変換部１４１１、モデル演算部１４１２、モデル変換部１４１３＃、モデル加算部１４１４、モデル変換部１４１５、モデル変換部１４１６、モデル加算部１４１７及びモデル変換部１４１８を備える。
図１３に示されるモデル変換部１４１１、モデル演算部１４１２、モデル加算部１４１４、モデル変換部１４１５、モデル変換部１４１６、モデル加算部１４１７及びモデル変換部１４１８は、ぞれぞれ図６に示されているモデル変換部１４１１、モデル演算部１４１２、モデル加算部１４１４、モデル変換部１４１５、モデル変換部１４１６、モデル加算部１４１７及びモデル変換部１４１８と同じ構成のため、説明を省略する。
FIG. 13 is a block diagram schematically showing a configuration of a
As illustrated in FIG. 13, the
The
モデル変換部１４１３＃は、モデル演算部１４１２からのトルク信号Ｓ２１と、アクチュエータ２の磁気部２１からの電流信号Ｓ３を受け取る。モデル変換部１４１３＃は、これらの信号に基づく推定加速度信号Ｓ２２をモデル加算部１４１４に与える。モデル変換部１４１３＃の伝達関数は、イナーシャの推定値Ｊｍを用いて表すと、１／Ｊｍである。
モデル変換部１４１３＃は、電流信号Ｓ３を元にイナーシャの推定値Ｊｍを再設定する。モデル変換部１４１３＃の動作は、後に図１５を用いて説明する。
図１４（ａ）〜（ｃ）は、実施の形態１において、イナーシャＪとイナーシャの推定値Ｊｍとが異なる場合のアクチュエータ２のパルス応答を示す図である。具体的には、図１４（ａ）〜（ｃ）は、Ｊ／Ｊｍ＝１．２の場合のパルス応答を示す。
図１４（ａ）〜（ｃ）は、判定部１３で位置信号Ｓ５が更新されたかどうかが判定され、判定結果がＹＥＳの場合は、ゲインＫ１、Ｋ２及びＫ３が正の値に設定され、判定結果がＮＯの場合は、ゲインＫ１、Ｋ２及びＫ３が全て０にされたときの図である。
Figure 14 (a) ~ (c), in the first embodiment, the inertia J and the estimated value J m of inertia is a diagram illustrating the pulse response of the
Figure 14 (a) ~ (c), it is determined whether or not the position signal S 5 by the
図１４（ａ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えたときの目標発生トルク信号Ｓ０の変化が示されている。縦軸は、目標発生トルク信号Ｓ０（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 14A, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). Nm), and the change in the target generated torque signal S 0 when the value is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 11 seconds has elapsed. The vertical axis represents the target generated torque signal S 0 (Nm), and the horizontal axis represents time (sec).
図１４（ｂ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えたときのトルク信号Ｓ１７のパルス応答が示されている。縦軸は、トルク信号Ｓ１７（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 14B, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), the pulse response of the torque signal S 17 has been shown when changing the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the torque signal S 17 (Nm), and the horizontal axis represents time (sec).
図１４（ｃ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えたときの電流信号Ｓ３のパルス応答が示されている。縦軸は、電流信号Ｓ３（Ａ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 14C, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), the pulse response of the current signal S 3 is shown when changing the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the current signal S 3 (A), and the horizontal axis represents time (sec).
図１４（ｂ）に示されるように、イナーシャＪとイナーシャの推定値Ｊｍとが異なる場合、トルク信号Ｓ１７と目標発生トルク信号Ｓ０との間に誤差が生じる。これは、Ｊ＝Ｊｍの場合に比べ、外乱オブザーバ部１４から出力される電流信号Ｓ２の絶対値が大きくなるからである。この電流信号Ｓ２は制御部１２に入力されるため、トルク信号Ｓ１７に誤差が生じる。目標発生トルク信号Ｓ０の変化量をＳ０＿ｅ、トルク信号Ｓ１７の変化量をＳ１７＿ｅとし、トルク信号Ｓ１７と目標発生トルク信号Ｓ０との間の誤差をｄｉｆ＿τとすると、ｄｉｆ＿τ＝Ｓ１７＿ｅ−Ｓ０＿ｅである。図１４の場合、Ｓ１７＿ｅ＝２．３８６×１０−４（Ｎｍ）、Ｓ０＿ｅ＝２×１０−４（Ｎｍ）、ｄｉｆ＿τ＝０．３８６×１０−４（Ｎｍ）である。
As shown in FIG. 14 (b), if the estimated value J m of inertia J and the inertia is different, an error occurs between the torque signal S 17 and the target generation torque signal S 0. This, compared with the case of J = J m, because the absolute value of the current signal S 2 output from the
一方、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の電流信号Ｓ３と、目標発生トルク信号Ｓ０を６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変えた時の電流信号Ｓ３との差をＳ３＿ｅとする。言い換えると、Ｓ３＿ｅは、目標発生トルク信号Ｓ０がＳ０＿ｅの時の電流信号Ｓ３の値と、目標発生トルク信号Ｓ０が０の時の電流信号Ｓ３の値との差である。但し、図１４（ｃ）に示されるように、目標発生トルク信号Ｓ０が０の時の電流信号Ｓ３は、１秒経過までの値ではなく、６秒経過後から１１秒経過までの値であることに注意する。１秒経過まではアクチュエータは静止した状態であり、外乱である摩擦トルクは静止摩擦トルクである。実際には、図３におけるアクチュエータ２の変換部２２４は、動摩擦トルクを模擬したブロックである。そこで、アクチュエータが動作する１秒経過後での電流信号Ｓ３を採用する。
On the other hand, 2 × a current signal S 3 when the target generation torque signal S 0 was changed after lapse of one second from 0 (Nm) to 2 × 10 -4 (Nm), the target generation torque signal S 0 after the lapse of 6 seconds the difference between the current signal S 3 when changing from 10 -4 (Nm) to 0 (Nm) and S 3_e. In other words, S 3_E the target generation torque signal S 0 is the difference between the value of the current signal S 3 when the S 0_E, the value of the current signal S 3 when the target generation torque signal S 0 is 0. However, as shown in FIG. 14 (c), the current signal S 3 when the target generation torque signal S 0 is 0 is not a value of up to one second has elapsed, from after 6 seconds to elapse 11 seconds value Note that The actuator remains stationary until 1 second elapses, and the friction torque that is a disturbance is the static friction torque. Actually, the
トルク信号Ｓ１７と目標発生トルク信号Ｓ０との間に誤差が生じるのと同じ理由で、Ｓ３＿ｅも理想値との誤差が生じる。ここで理想値とは、機構部２２のイナーシャＪとモデル機構部１４１のイナーシャの推定値Ｊｍとが同じ場合のＳ３＿ｅを指す。同時に、理想値を目標発生トルク信号Ｓ０の変化量Ｓ０＿ｅと、電流信号をトルク信号に変換する変換係数の推定値Ｋｔｍとを用いて表すと、Ｓ０＿ｅ／Ｋｔmとなる。Ｓ３＿ｅと理想値との誤差をｄｉｆ＿ｉとする。図１４の場合、Ｓ３＿ｅ＝０．３０４３（Ａ）である。また、Ｋｔm＝７．８４４×１０−４（Ｎｍ／Ａ）と設定しているので、理想値は０．２５５（Ａ）である。よって、ｄｉｆ＿ｉ＝０．０４９３（Ａ）である。
For the same reason that an error occurs between the torque signal S 17 and the target generated torque signal S 0 , an error from the ideal value also occurs in S 3 — e . Here, the ideal value indicates S 3 — e when the inertia J of the
図１５（ａ）及び（ｂ）は、実施の形態１において、イナーシャＪとイナーシャの推定値Ｊｍとの比に対する、誤差ｄｉｆ＿τと誤差ｄｉｆ＿ｉとを示す図である。
図１５（ａ）及び（ｂ）は、判定部１３で位置信号Ｓ５が更新されたかどうかが判定され、判定結果がＹＥＳの場合は、ゲインＫ１、Ｋ２及びＫ３が正の値に設定され、判定結果がＮＯの場合は、ゲインＫ１、Ｋ２及びＫ３が全て０とされたときの図である。
FIGS. 15A and 15B are diagrams showing the error dif_τ and the error dif_i with respect to the ratio of the inertia J and the estimated value J m of inertia in the first embodiment.
Figure 15 (a) and 15 (b), it is determined whether or not the position signal S 5 by the
図１５（ａ）には、イナーシャＪとイナーシャの推定値Ｊｍとの比を変えた時の誤差ｄｉｆ＿τの変化が示されている。縦軸は、誤差ｄｉｆ＿τ（Ｎｍ）であり、横軸はＪ／Ｊｍ−１である。 FIG. 15A shows a change in the error dif_τ when the ratio of the inertia J and the estimated value J m of the inertia is changed. The vertical axis is the error dif_τ (Nm), and the horizontal axis is J / J m −1.
図１５（ｂ）には、イナーシャＪとイナーシャの推定値Ｊｍとの比を変えた時の誤差ｄｉｆ＿ｉの変化が示されている。縦軸は、誤差ｄｉｆ＿ｉ（Ａ）であり、横軸はＪ／Ｊｍ−１である。 FIG. 15B shows a change in the error dif_i when the ratio of the inertia J and the estimated value J m of the inertia is changed. The vertical axis is error dif_i (A), and the horizontal axis is J / J m −1.
図１５（ａ）及び（ｂ）に示されるように、誤差ｄｉｆ＿τ及び誤差ｄｉｆ＿ｉは、Ｊ／Ｊｍ−１に比例し、かつ（０，０）を交点に持つ。このことから、誤差ｄｉｆ＿ｉが０となるようイナーシャの推定値Ｊｍを再設定することで、トルク信号Ｓ１７を目標発生トルク信号Ｓ０に追従させることができる。 As shown in FIGS. 15A and 15B, the error dif_τ and the error dif_i are proportional to J / J m −1 and have (0, 0) at the intersection. Thus, the torque signal S 17 can be made to follow the target generated torque signal S 0 by resetting the estimated value J m of the inertia so that the error dif_i becomes zero.
図１６（ａ）〜（ｃ）は、実施の形態１において、イナーシャの推定値Ｊｍを再設定した場合のアクチュエータ２のパルス応答を示す図である。
図１６（ａ）〜（ｃ）は、判定部１３で位置信号Ｓ５が更新されたかどうかが判定され、判定結果がＹＥＳの場合は、ゲインＫ１、Ｋ２及びＫ３が正の値に設定され、判定結果がＮＯの場合は、ゲインＫ１、Ｋ２及びＫ３が全て０とされたときのパルス応答を示す。
Figure 16 (a) ~ (c), in the first embodiment, shows the pulse response of the
Figure 16 (a) ~ (c), it is determined whether or not the position signal S 5 by the
図１６（ａ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の目標発生トルク信号Ｓ０の変化が示されている。縦軸は、目標発生トルク信号Ｓ０（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 16A, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). Nm), and a change in the target generated torque signal S 0 when 11 (second) is changed from 0 (Nm) to 2 × 10 −4 (Nm) is shown. The vertical axis represents the target generated torque signal S 0 (Nm), and the horizontal axis represents time (sec).
図１６（ｂ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時のトルク信号Ｓ１７のパルス応答が示されている。縦軸は、トルク信号Ｓ１７（Ｎｍ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 16B, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), there is shown a pulse response of the torque signal S 17 when varying the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm). The vertical axis represents the torque signal S 17 (Nm), and the horizontal axis represents time (sec).
図１６（ｃ）には、目標発生トルク信号Ｓ０を１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変え、６秒経過後に２×１０−４（Ｎｍ）から０（Ｎｍ）に変え、１１秒経過後に０（Ｎｍ）から２×１０−４（Ｎｍ）に変えた時の電流信号Ｓ３のパルス応答が示されている。縦軸は、電流信号Ｓ３（Ａ）であり、横軸は時間（ｓｅｃ）である。 In FIG. 16C, the target generated torque signal S 0 is changed from 0 (Nm) to 2 × 10 −4 (Nm) after 1 second, and from 2 × 10 −4 (Nm) to 0 (after 6 seconds). changed to Nm), the pulse response of the current signal S 3 when changing the after 11 seconds 0 (Nm) to 2 × 10 -4 (Nm) is shown. The vertical axis represents the current signal S 3 (A), and the horizontal axis represents time (sec).
図１６（ｂ）に示されるように、イナーシャの推定値Ｊｍを再設定した場合、トルク信号Ｓ１７は、目標発生トルク信号Ｓ０との誤差がなく、目標発生トルク信号Ｓ０に追従できている。また、判定部１３で、電流信号Ｓ３が予め定められた値以内かどうかを更に判定した場合、又は、誤差信号Ｓ１１が予め定められた値以内かどうかを更に判定した場合についても、同様の効果が期待される。
As shown in FIG. 16 (b), when re-setting the estimated value J m of inertia torque signal S 17 has no error between the target generation torque signal S 0, can follow the target generated torque signal S 0 ing. Further, the
なお、アクチュエータ２がＤＣモータで、ＤＣモータのイナーシャの推定値Ｊｍを再設定した場合について説明したが、実施の形態１は、ＤＣモータ以外にも適用できる。また、アクチュエータ２の発生力を目標発生力に追従させる場合にも適用できる。この場合、再設定する推定パラメータはアクチュエータ２の質量の推定値である。また、誤差ｄｉｆ＿ｉは、Ｓ３＿ｅと理想値との誤差である。この場合、理想値は、アクチュエータ２の質量とその推定値が同じ場合のＳ３＿ｅを指す。同時に、理想値を目標発生力信号の変化量Ｓ０＿ｅ＃と、電流信号を力信号に変換する変換係数Ｋｆの推定値Ｋｆmとを用いて表すと、Ｓ０＿ｅ＃／Ｋｆmとなる。
In addition, although the case where the
以上に説明したように、実施の形態１に係るアクチュエータ制御装置１及びアクチュエータ制御方法によれば、アクチュエータ２の質量とその推定値との間に誤差が生じた場合、誤差ｄｉｆ＿ｉが０になるよう質量の推定値を再設定することで、アクチュエータ２の発生力を目標発生力に追従させることができる。
As described above, according to the
１ アクチュエータ制御装置、 １１ 信号出力部、 １２ 制御部、 １２１ 演算部、 １２２ 制御フィルタ部、 １３ 判定部、 １４ 外乱オブザーバ部、 １４１ モデル機構部、 １４２ 減算部、 １４３ ゲイン変更部、 １４４ 積分器、 １４５ モデル変換部、 ２ アクチュエータ、 ２１ 磁気部、 ２１１ 減算部、 ２１２ 変換部、 ２２ 機構部、 ２２１ 変換部、 ２２２ 減算部、 ２２３〜２２５ 変換部、 ２３ 変換部。
DESCRIPTION OF
Claims (8)
検出された前記可動部の位置に誤差があるか否かの判定を行う判定部と、
前記可動部を動作させるための動作電流から前記可動部の位置を推定し、前記検出された前記可動部の位置及び前記可動部の推定された位置を用いて、補正信号を出力する外乱オブザーバ部と、
前記補正信号に基づいて前記アクチュエータを制御し、前記アクチュエータの発生力を前記アクチュエータの目標発生力に追従させる制御部と、を備え、
前記外乱オブザーバ部は、前記判定の結果に応じて、前記補正信号を生成するための外乱補正ゲインを変更すること
を特徴とするアクチュエータ制御装置。 An actuator control device for controlling an actuator having a movable part,
A determination unit that determines whether there is an error in the position of the detected movable unit;
A disturbance observer unit that estimates a position of the movable unit from an operating current for operating the movable unit, and outputs a correction signal using the detected position of the movable unit and the estimated position of the movable unit When,
A controller that controls the actuator based on the correction signal and causes the generated force of the actuator to follow the target generated force of the actuator;
The actuator according to claim 1, wherein the disturbance observer unit changes a disturbance correction gain for generating the correction signal according to a result of the determination.
を特徴とする請求項１に記載のアクチュエータ制御装置。 The determination unit confirms whether or not the detected position has been updated. If the detected position is not updated, the determination unit determines that there is an error, and the detected position is updated. 2. The actuator control device according to claim 1, wherein it is determined that the error does not occur.
を特徴とする請求項１又は２に記載のアクチュエータ制御装置。 The disturbance observer unit sets the disturbance correction gain to a set value that is a positive value when it is determined that there is no error, and sets the disturbance correction gain when the error is determined. The actuator control device according to claim 1, wherein the actuator control device is set to a positive value smaller than a set value or 0.
を特徴とする請求項１から３の何れか一項に記載のアクチュエータ制御装置。 4. The actuator control according to claim 1, wherein the disturbance observer unit generates the correction signal using a difference between the detected position and the estimated position. 5. apparatus.
前記動作電流に相当する電流信号を前記発生力に相当する力信号に変換する変換係数の推定値をＫｆｍとし、前記目標発生力の値をＳにした場合の前記動作電流の電流値と前記目標発生力の値を０にした場合の前記動作電流の電流値との差をｄとすると、
（１）式を満たしていない場合に、前記モデル機構における前記可動部の質量の推定値を修正すること
ｄ＝Ｓ／Ｋｆｍ （１）
を特徴とする請求項１から４の何れか一項に記載のアクチュエータ制御装置。 The disturbance observer unit estimates the position of the movable unit from the operating current by using a model mechanism that simulates the characteristics of the actuator,
An estimated value of a conversion coefficient for converting a current signal corresponding to the operating current into a force signal corresponding to the generated force is K fm, and the current value of the operating current when the target generated force value is S and the When the difference from the current value of the operating current when the value of the target generated force is 0 is d,
When the formula (1) is not satisfied, the estimated value of the mass of the movable part in the model mechanism is corrected. D = S / K fm (1)
The actuator control device according to any one of claims 1 to 4, wherein
を特徴とする請求項１から５の何れか一項に記載のアクチュエータ制御装置。 The determination unit checks whether or not the detected position of the movable part is updated in a cycle shorter than a cycle in which the position of the movable unit is detected. The actuator control device according to any one of the above.
を特徴とする請求項６に記載のアクチュエータ制御装置。 The actuator control device according to claim 6, wherein the determination unit confirms whether or not the detected position of the movable unit is updated at a minimum sampling period for controlling the actuator.
前記検出された前記可動部の位置に誤差があるか否かの判定を行い、
前記可動部を動作させるための動作電流から前記可動部の位置を推定し、
前記判定の結果に応じて外乱補正ゲインを変更した後に、前記検出された前記可動部の位置及び前記可動部の推定された位置を用いて補正信号を生成し、
前記補正信号に基づいて前記アクチュエータを制御し、前記アクチュエータの発生力を前記アクチュエータの目標発生力に追従させること
を特徴とするアクチュエータ制御方法。 An actuator control method for controlling an actuator having a movable part,
It is determined whether there is an error in the position of the detected movable part,
Estimating the position of the movable part from the operating current for operating the movable part,
After changing the disturbance correction gain according to the result of the determination, a correction signal is generated using the detected position of the movable part and the estimated position of the movable part,
An actuator control method comprising: controlling the actuator based on the correction signal to cause the generated force of the actuator to follow the target generated force of the actuator.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018016908A JP2019133537A (en) | 2018-02-02 | 2018-02-02 | Actuator controller and actuator control method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018016908A JP2019133537A (en) | 2018-02-02 | 2018-02-02 | Actuator controller and actuator control method |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2019133537A true JP2019133537A (en) | 2019-08-08 |
Family
ID=67545042
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2018016908A Pending JP2019133537A (en) | 2018-02-02 | 2018-02-02 | Actuator controller and actuator control method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2019133537A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20210058643A (en) * | 2019-11-14 | 2021-05-24 | 가부시키가이샤 히타치세이사쿠쇼 | Plant control apparatus and plant control method |
-
2018
- 2018-02-02 JP JP2018016908A patent/JP2019133537A/en active Pending
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20210058643A (en) * | 2019-11-14 | 2021-05-24 | 가부시키가이샤 히타치세이사쿠쇼 | Plant control apparatus and plant control method |
| KR102367345B1 (en) * | 2019-11-14 | 2022-02-25 | 가부시키가이샤 히타치세이사쿠쇼 | Plant control apparatus and plant control method |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5650814B1 (en) | Motor control device with feedforward control | |
| JP3796261B1 (en) | Motor load inertia estimation method | |
| KR101502020B1 (en) | Periodicity disturbance suppression device and periodicity disturbance suppression method | |
| Derammelaere et al. | Sensorless load angle control for two-phase hybrid stepper motors | |
| JP6140225B2 (en) | Motor control device having magnetic flux controller, machine learning device and method thereof | |
| JP4914979B2 (en) | Motor control device and motor control method | |
| JP4862752B2 (en) | Electric inertia control method | |
| JP5127767B2 (en) | Drive control device | |
| JP2006215626A (en) | Position controller | |
| JP2010019713A (en) | Electric inertia control device of power meter system | |
| JP2019133537A (en) | Actuator controller and actuator control method | |
| KR20200033478A (en) | Automated torque ripple reduction apparatus of motor | |
| EP2808992B1 (en) | Motor control device | |
| JP5924290B2 (en) | Motor control device | |
| JP6930868B2 (en) | Servo control device, servo control method and system | |
| JP5845433B2 (en) | Motor drive device | |
| JP2010033172A (en) | Digital servo control unit using feedforward signal | |
| JP2004023910A (en) | Motor control device | |
| JP4726346B2 (en) | Servo motor control device | |
| JP6556353B2 (en) | Elevator control device | |
| JP2008289218A (en) | Motor controller and control method thereof | |
| JP2004064949A (en) | Positional control system of ultrasonic motor | |
| Gennaro | Adaptive output feedback control of synchronous motors | |
| CN109067271B (en) | DC motor servo control method based on robust disturbance compensation scheme | |
| JP5424762B2 (en) | Electric motor current control device |