JP2018023203A - Motor controller - Google Patents

Motor controller Download PDF

Info

Publication number
JP2018023203A
JP2018023203A JP2016152023A JP2016152023A JP2018023203A JP 2018023203 A JP2018023203 A JP 2018023203A JP 2016152023 A JP2016152023 A JP 2016152023A JP 2016152023 A JP2016152023 A JP 2016152023A JP 2018023203 A JP2018023203 A JP 2018023203A
Authority
JP
Japan
Prior art keywords
detection
error
value
angle
rotation angle
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
Application number
JP2016152023A
Other languages
Japanese (ja)
Other versions
JP6664288B2 (en
Inventor
宏明 河合
Hiroaki Kawai
宏明 河合
西田 吉晴
Yoshiharu Nishida
吉晴 西田
敏章 下田
Toshiaki Shimoda
敏章 下田
貴士 徳山
Takashi Tokuyama
貴士 徳山
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kobe Steel Ltd
Original Assignee
Kobe Steel Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kobe Steel Ltd filed Critical Kobe Steel Ltd
Priority to JP2016152023A priority Critical patent/JP6664288B2/en
Publication of JP2018023203A publication Critical patent/JP2018023203A/en
Application granted granted Critical
Publication of JP6664288B2 publication Critical patent/JP6664288B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

PROBLEM TO BE SOLVED: To achieve highly precise compensation of a detection error included in a detection angle of a rotor without necessity of connection of an external apparatus for driving a motor at a constant speed.SOLUTION: An estimation unit 22 inputs an angle detection value θs and a torque detection value τd into an equation of motion showing a relationship between the angle detection value θs including a detection error θc and the torque detection value τd and sequentially applies a least square method to estimate the detection error θc. A compensation unit 23 compensates for the detection error included in the angle detection value θs on the basis of the detection error estimated by the estimation unit 22.SELECTED DRAWING: Figure 1

Description

本発明は、電動機の制御装置に関するものである。   The present invention relates to a control device for an electric motor.

電動機の制御装置は、例えばレゾルバのような角度検出手段が検出した回転子の角度情報を用いて、速度制御やトルク制御といった電動機の駆動制御を行う。角度検出手段が検出する角度情報には、角度検出手段の特性に起因して検出誤差が含まれるのが一般的である。この検出誤差を含む角度情報を用いて、電動機の駆動制御が行われると、電動機の回転速度や出力トルクに脈動が発生する可能性がある。そのため、角度検出手段が検出した角度情報に含まれる検出誤差を適切に補正する必要がある。   The motor control device performs drive control of the motor, such as speed control and torque control, using angle information of the rotor detected by an angle detection unit such as a resolver. In general, the angle information detected by the angle detection means includes a detection error due to the characteristics of the angle detection means. When drive control of the electric motor is performed using angle information including this detection error, pulsation may occur in the rotational speed and output torque of the electric motor. Therefore, it is necessary to appropriately correct the detection error included in the angle information detected by the angle detection means.

上記の課題解決を目的とした従来技術として、特許文献1、2がある。特許文献1は、電動機の理想回転角度を設定し、その理想回転角度と実検出角度との差を求めることで、実検出角度に含まれる検出誤差を補償する技術を開示する。   Patent Documents 1 and 2 are known as conventional techniques for solving the above problems. Patent Document 1 discloses a technique for compensating for a detection error included in an actual detection angle by setting an ideal rotation angle of an electric motor and obtaining a difference between the ideal rotation angle and the actual detection angle.

特許文献2は、モータの磁極位置を検出する磁気位置センサーが検出した検出信号の検出誤差を補償する技術を開示する。具体的には、特許文献2は、無負荷状態において、モータの出力トルクを0にするdq電流指令値を与えたときのdq電流指令値の位相差βと、実際のdq軸電流の位相差βとの位相ズレ量を求め、検出誤差を補償する技術を開示する。 Patent Document 2 discloses a technique for compensating for a detection error of a detection signal detected by a magnetic position sensor that detects a magnetic pole position of a motor. Specifically, Patent Document 2 describes the phase difference β * of the dq current command value when the dq current command value for setting the output torque of the motor to 0 in the no-load state and the actual dq axis current level. A technique for obtaining a phase shift amount from the phase difference β and compensating for a detection error is disclosed.

特開2013−72686号公報JP2013-72686A 特開2007−318894号公報JP 2007-318894 A

しかし、特許文献1では、検出誤差を精度良く求めるために、補償対象となる電動機を、一定の回転速度で正確に駆動する必要がある。補償対象となる電動機の実検出角には、上述のように検出誤差が含まれている。そのため、特許文献1は、正確に一定速度で電動機を駆動させることが困難である。   However, in Patent Document 1, it is necessary to accurately drive a motor to be compensated at a constant rotational speed in order to obtain a detection error with high accuracy. The actual detection angle of the motor to be compensated includes a detection error as described above. Therefore, in Patent Document 1, it is difficult to drive the electric motor accurately at a constant speed.

また、特許文献1において、別途、電動機を強制的に一定速度で駆動させるための外部装置を電動機に接続し、電動機を一定速度で駆動させることも考えられるが、この場合、装置のコストアップ及び装置の大型化を招くという問題が発生する。   In Patent Document 1, it is conceivable that an external device for forcibly driving the motor at a constant speed is connected to the motor and the motor is driven at a constant speed. The problem of increasing the size of the apparatus occurs.

特許文献2では、無負荷状態で求められた位相ズレ量を用いて磁気位置センサーの検出誤差が補償されているので、負荷がかかった状態において、検出信号の検出誤差を正確に補償できない可能性がある。   In Patent Document 2, since the detection error of the magnetic position sensor is compensated using the phase shift amount obtained in the no-load state, there is a possibility that the detection error of the detection signal cannot be accurately compensated in the loaded state. There is.

本発明は、電動機を一定速度で駆動させる外部装置を接続しなくても回転子の検出角度に含まれる検出誤差を精度良く補償する電動機の制御装置を提供することを目的とする。   It is an object of the present invention to provide a motor control device that accurately compensates for a detection error included in a rotor detection angle without connecting an external device that drives the motor at a constant speed.

本発明の一態様に係る電動機の制御装置は、
前記電動機の回転子の回転角度に応じて周期的に変動する検出誤差と前記回転角度の真値とを含む前記回転子の実回転角度を検出する角度検出部と、
前記電動機の実出力トルクを検出するトルク検出部と、
前記実回転角度を駆動制御に用いることで発生する前記実出力トルクの周期的な変動から前記検出誤差を推定する推定部と、
前記推定された検出誤差に基づいて、前記実回転角度に含まれる検出誤差を補償する。
An electric motor control device according to an aspect of the present invention includes:
An angle detection unit for detecting an actual rotation angle of the rotor including a detection error periodically changing according to a rotation angle of the rotor of the electric motor and a true value of the rotation angle;
A torque detector for detecting an actual output torque of the electric motor;
An estimation unit that estimates the detection error from a periodic variation of the actual output torque generated by using the actual rotation angle for drive control;
Based on the estimated detection error, the detection error included in the actual rotation angle is compensated.

本態様によれば、検出誤差を含んだ実回転角度を駆動制御に用いることで発生する実出力トルクの周期的な変動に基づいて検出誤差が推定されている。周期的に変動する検出誤差を含んだ実回転角度を電動機の駆動制御に用いた場合、実出力トルクには、検出誤差と同じ周期で、検出誤差の大きさに応じた脈動が発生する。そのため、実回転角度と実出力トルクが同時に分かれば、実回転角度に含まれる検出誤差を正確に推定できる。したがって、本態様は、実回転角度に含まれる検出誤差を正確に推定できる。   According to this aspect, the detection error is estimated based on the periodic fluctuation of the actual output torque generated by using the actual rotation angle including the detection error for the drive control. When an actual rotation angle including a periodically varying detection error is used for drive control of the electric motor, a pulsation corresponding to the magnitude of the detection error occurs in the actual output torque in the same cycle as the detection error. Therefore, if the actual rotation angle and the actual output torque are known at the same time, the detection error included in the actual rotation angle can be accurately estimated. Therefore, this aspect can accurately estimate the detection error included in the actual rotation angle.

また、本態様は、実回転角度と実出力トルクとに着目しているので、電動機の回転速度を一定にする必要はない。よって、本態様は、回転速度を一定に保持するための外部装置を用いることなく、検出誤差を推定できる。したがって、本態様は、コストの増大及び装置規模の増大を抑制できる。   Further, since this aspect focuses on the actual rotation angle and the actual output torque, it is not necessary to make the rotation speed of the electric motor constant. Therefore, this aspect can estimate a detection error without using an external device for keeping the rotation speed constant. Therefore, this aspect can suppress an increase in cost and an increase in apparatus scale.

上記態様において、前記推定部は、前記実回転角度と前記実出力トルクとの関係を示す運動方程式に、前記実回転角度と前記実出力トルクとを入力することで、前記検出誤差を推定してもよい。   In the above aspect, the estimation unit estimates the detection error by inputting the actual rotation angle and the actual output torque into an equation of motion indicating a relationship between the actual rotation angle and the actual output torque. Also good.

本態様によれば、実回転角度と実出力トルクとの関係を示す運動方程式を用いて検出誤差が推定されているので、検出誤差を精度良く推定できる。   According to this aspect, since the detection error is estimated using the equation of motion indicating the relationship between the actual rotation angle and the actual output torque, the detection error can be estimated with high accuracy.

上記態様において、前記実回転角度は、前記真値を変数とする三角関数に誤差ゲインを乗じた誤差関数と、前記真値との和で表され、
前記推定部は、複数の前記実回転角度と複数の前記実出力トルクとを前記運動方程式に入力し、最小二乗法によって、前記誤差ゲインを決定することにより、前記検出誤差を推定してもよい。
In the above aspect, the actual rotation angle is represented by a sum of an error function obtained by multiplying a trigonometric function having the true value as a variable by an error gain, and the true value,
The estimation unit may estimate the detection error by inputting a plurality of actual rotation angles and a plurality of actual output torques to the equation of motion, and determining the error gain by a least square method. .

検出誤差は、回転角度に応じて周期的に変動するので、回転角度の真値を変数とする三角関数に誤差ゲインを乗じた誤差関数で表すことができる。本態様は、この誤差関数と真値との和で実回転角度が表された運動方程式を用いている。そして、本態様は、この運動方程式に複数の実回転角度と複数の実出力トルクとを入力し、最小二乗法によって、誤差ゲインを決定することで、検出誤差を推定する。そのため、検出誤差を精度良く推定できる。なお、メモリ量の削減の観点から、本態様は、逐次最小二乗法を用いても良い。   Since the detection error periodically varies according to the rotation angle, it can be expressed by an error function obtained by multiplying a trigonometric function having a true value of the rotation angle as a variable by an error gain. This mode uses an equation of motion in which the actual rotation angle is expressed by the sum of the error function and the true value. In this aspect, a plurality of actual rotation angles and a plurality of actual output torques are input to this equation of motion, and an error gain is determined by the least square method, thereby estimating a detection error. Therefore, the detection error can be estimated with high accuracy. From the viewpoint of reducing the amount of memory, this aspect may use a sequential least square method.

上記態様において、前記推定部は、前記最小二乗法によって決定された誤差ゲインで表された前記誤差関数から、複数の回転角度と複数の検出誤差とを対応付けた対応情報を生成し、
前記補償部は、前記実回転角度に対応する検出誤差を前記対応情報から決定し、決定した検出誤差を用いて前記実回転角度を補償してもよい。
In the above aspect, the estimation unit generates correspondence information in which a plurality of rotation angles and a plurality of detection errors are associated with each other from the error function represented by the error gain determined by the least square method.
The compensation unit may determine a detection error corresponding to the actual rotation angle from the correspondence information, and compensate the actual rotation angle using the determined detection error.

本態様によれば、最小二乗法によって決定された誤差ゲインで表された誤差関数から、複数の回転角度と複数の検出誤差とを対応付けた対応情報が事前に生成される。そして、本態様によれば、実回転角度に対応する検出誤差を対応情報から決定し、決定した検出誤差を用いて実回転角度を補償する。そのため、実回転角度に応じた検出誤差を速やかに決定できる。   According to this aspect, correspondence information in which a plurality of rotation angles and a plurality of detection errors are associated with each other is generated in advance from an error function represented by an error gain determined by the least square method. According to this aspect, the detection error corresponding to the actual rotation angle is determined from the correspondence information, and the actual rotation angle is compensated using the determined detection error. Therefore, the detection error corresponding to the actual rotation angle can be determined quickly.

上記態様において、前記電動機に流れる電流を検出する電流検出部を更に備え、
前記トルク検出部は、前記検出された電流に基づいて、前記実出力トルクを算出してもよい。
In the above aspect, further comprising a current detector for detecting a current flowing through the electric motor,
The torque detector may calculate the actual output torque based on the detected current.

本態様によれば、電流検出部により検出された電流に基づいて、実出力トルクが算出されているので、比較的、装置規模の大きなトルク検出装置を用いることなく、実出力トルクを検出できる。そのため、本態様は、装置規模の増大を更に抑制できる。   According to this aspect, since the actual output torque is calculated based on the current detected by the current detection unit, the actual output torque can be detected without using a torque detection device having a relatively large scale. Therefore, this aspect can further suppress an increase in the device scale.

上記態様において、前記角度検出部は、レゾルバで構成されてもよい。   In the above aspect, the angle detection unit may be configured by a resolver.

レゾルバは、回転子の回転角度に応じて検出誤差が周期的に変動するので、上記の態様を用いることで、検出誤差を正確に推定できる。   Since the detection error of the resolver periodically varies according to the rotation angle of the rotor, the detection error can be accurately estimated by using the above aspect.

本発明によれば、外部装置を接続しなくても回転子の検出角度に含まれる検出誤差を精度良く補償することができる。   According to the present invention, the detection error included in the detection angle of the rotor can be accurately compensated without connecting an external device.

本発明の実施の形態1に係る電動機の制御装置の構成を示すブロック図である。It is a block diagram which shows the structure of the control apparatus of the electric motor which concerns on Embodiment 1 of this invention. 推定部における処理の流れを示すブロック線図である。It is a block diagram which shows the flow of a process in an estimation part. 対応情報の説明図である。It is explanatory drawing of correspondence information. 本発明の実施の形態2に係る制御装置の構成を示すブロック図である。It is a block diagram which shows the structure of the control apparatus which concerns on Embodiment 2 of this invention. トルク推定部に注目したブロック図である。It is a block diagram which paid its attention to the torque estimation part.

以下、本発明の実施の形態に係る電動機(以下、「モータ」と記述する。)の制御装置について図面を参照しながら説明する。永久磁石同期電動機をはじめとした3相ブラシレスモータの速度制御は、近年、ベクトル制御が用いられることが一般的である。したがって、本実施の形態においても、モータの速度制御として、ベクトル制御を採用する。   Hereinafter, a control device for an electric motor (hereinafter referred to as “motor”) according to an embodiment of the present invention will be described with reference to the drawings. In recent years, vector control is generally used for speed control of a three-phase brushless motor such as a permanent magnet synchronous motor. Therefore, also in this embodiment, vector control is adopted as the motor speed control.

(実施の形態1)
図1は、本発明の実施の形態1に係る電動機の制御装置1の構成を示すブロック図である。制御装置1は、モータMを制御する制御装置である。
(Embodiment 1)
FIG. 1 is a block diagram showing a configuration of an electric motor control apparatus 1 according to Embodiment 1 of the present invention. The control device 1 is a control device that controls the motor M.

制御装置1は、減算器11、速度制御部12、電流指令生成部13、減算器14a,14b、電流制御部15、dq/uvw変換部16、インバータ17、トルク検出部19、角度検出部20、uvw/dq変換部21、推定部22、補償部23、加算器24、乗算器25、及び速度算出部26を備える。   The control device 1 includes a subtractor 11, a speed controller 12, a current command generator 13, subtractors 14a and 14b, a current controller 15, a dq / uvw converter 16, an inverter 17, a torque detector 19, and an angle detector 20. , Uvw / dq conversion unit 21, estimation unit 22, compensation unit 23, adder 24, multiplier 25, and speed calculation unit 26.

図1において、減算器11、速度制御部12、電流指令生成部13、減算器14a,14b、電流制御部15、dq/uvw変換部16、uvw/dq変換部21、推定部22、補償部23、加算器24、乗算器25、及び速度算出部26は、例えば、CPU、ROM等を備えるコンピュータにより構成される。   In FIG. 1, a subtractor 11, a speed control unit 12, a current command generation unit 13, subtractors 14a and 14b, a current control unit 15, a dq / uvw conversion unit 16, a uvw / dq conversion unit 21, an estimation unit 22, and a compensation unit. 23, the adder 24, the multiplier 25, and the speed calculation unit 26 are configured by, for example, a computer including a CPU, a ROM, and the like.

減算器11は、目標速度から速度検出値を減算し、速度偏差を算出する。目標速度は、モータMが適用される装置に応じて異なる。例えば、モータMが建設機械のウィンチドラムや上部旋回体や下部走行体の駆動に用いられるのであれば、操作レバーの操作量に応じた値に目標速度は設定される。また、モータMが電気自動車やハイブリッド自動車の走行モータに適用されるのであれば、アクセルの操作量に応じた値に目標速度は設定される。   The subtractor 11 subtracts the speed detection value from the target speed to calculate a speed deviation. The target speed varies depending on the device to which the motor M is applied. For example, if the motor M is used to drive a winch drum, an upper swing body, or a lower traveling body of a construction machine, the target speed is set to a value corresponding to the operation amount of the operation lever. Further, if the motor M is applied to a travel motor of an electric vehicle or a hybrid vehicle, the target speed is set to a value corresponding to the accelerator operation amount.

速度制御部12は、減算器11から速度偏差が入力され、この速度偏差を0にするためのトルク指令値を算出する。ここで、速度制御部12は、例えばPID(比例・積分・微分)制御やPI(比例・積分)制御を用いてトルク指令値を算出すればよい。   The speed control unit 12 receives a speed deviation from the subtractor 11 and calculates a torque command value for setting the speed deviation to zero. Here, the speed control unit 12 may calculate the torque command value using, for example, PID (proportional / integral / derivative) control or PI (proportional / integral) control.

電流指令生成部13は、トルク指令値に基づいて、d軸の目標電流値Id_refとq軸の目標電流値Iq_refとを算出する。ここで、電流指令生成部13は、例えば、トルク指令値に対して予め定められた値を目標電流値Id_ref,Iq_refとして生成すればよい。   The current command generator 13 calculates a d-axis target current value Id_ref and a q-axis target current value Iq_ref based on the torque command value. Here, the current command generation unit 13 may generate, for example, values predetermined for the torque command value as the target current values Id_ref and Iq_ref.

減算器14aは、目標電流値Id_refからd軸の実電流値Idを減算し、d軸の電流偏差を算出する。減算器14bは、目標電流値Iq_refからq軸の実電流値Iqを減算し、q軸の電流偏差を算出する。   The subtractor 14a subtracts the d-axis actual current value Id from the target current value Id_ref to calculate a d-axis current deviation. The subtractor 14b subtracts the q-axis actual current value Iq from the target current value Iq_ref to calculate a q-axis current deviation.

電流制御部15は、減算器14aからのd軸の電流偏差を0にするためのd軸の電圧指令値vdを算出すると共に、減算器14bからのq軸の電流偏差を0にするためのq軸の電圧指令値vqを算出する。電圧指令値vdはモータMに出力する電圧の界磁成分を制御する指令値であり、電圧指令値vqはモータMに出力する電圧のトルク成分を制御するための指令値である。ここで、電流制御部15は、例えば、PID制御、PI制御を用いて電圧指令値vd,vqを算出すればよい。   The current control unit 15 calculates a d-axis voltage command value vd for setting the d-axis current deviation from the subtractor 14a to zero, and sets the q-axis current deviation from the subtractor 14b to zero. The q-axis voltage command value vq is calculated. The voltage command value vd is a command value for controlling the field component of the voltage output to the motor M, and the voltage command value vq is a command value for controlling the torque component of the voltage output to the motor M. Here, the current control unit 15 may calculate the voltage command values vd and vq using, for example, PID control and PI control.

dq/uvw変換部16は、電圧指令値vd,vqを、乗算器25から出力された電気角αを用いて座標変換し、UVWの3相からなるPWM信号を生成し、インバータ17に出力する。   The dq / uvw conversion unit 16 performs coordinate conversion of the voltage command values vd and vq using the electrical angle α output from the multiplier 25, generates a PWM signal having three phases of UVW, and outputs the PWM signal to the inverter 17. .

インバータ17は、例えば、3相のインバータで構成され、3相のPWM信号からUVWの3相の交流電力を生成し、モータMに出力する。   The inverter 17 is configured by, for example, a three-phase inverter, generates UVW three-phase AC power from the three-phase PWM signal, and outputs the generated power to the motor M.

モータMは、例えば、3相の電動機で構成され、インバータ17から出力されるUVWの3相の交流電力に従って駆動される。例えば、制御装置1がクレーンやショベルカーといった建設機械に適用されるのであれば、モータMは、上部旋回体を旋回させたり、ウィンチドラムを回転させたりする。また、制御装置1が電気自動車に適用されるのであれば、電気自動車を走行させる。   The motor M is composed of, for example, a three-phase electric motor and is driven according to UVW three-phase AC power output from the inverter 17. For example, if the control device 1 is applied to a construction machine such as a crane or an excavator, the motor M rotates the upper swing body or rotates the winch drum. Moreover, if the control apparatus 1 is applied to an electric vehicle, the electric vehicle is caused to travel.

トルク検出部19は、例えば、モータMの回転軸に加わるトルクを直接的に検出する計測装置で構成されている。そして、トルク検出部19は、検出したトルクをトルク検出値として推定部22に出力する。   The torque detector 19 is configured by a measuring device that directly detects torque applied to the rotation shaft of the motor M, for example. Then, the torque detection unit 19 outputs the detected torque to the estimation unit 22 as a torque detection value.

角度検出部20は、例えば、レゾルバで構成され、モータMの回転子の回転角度を検出し、検出した回転角度を角度検出値θsとして出力する。ここで、角度検出値θsとしては、例えば、基準回転位置に対する回転子の回転角度が採用できる。なお、速度検出値は、例えば、回転子が所定の第1方向(例えば、右回りの方向)に回転している場合、プラスの値を持ち、回転子が第1方向とは反対の第2方向(例えば、左回りの方向)に回転した場合は、マイナスの値を持つようにして、プラスマイナスの符号を用いて回転方向を区別してもよい。   The angle detection unit 20 is configured by, for example, a resolver, detects the rotation angle of the rotor of the motor M, and outputs the detected rotation angle as an angle detection value θs. Here, as the angle detection value θs, for example, the rotation angle of the rotor with respect to the reference rotation position can be adopted. The speed detection value has a positive value when, for example, the rotor rotates in a predetermined first direction (for example, clockwise direction), and the rotor has a second value opposite to the first direction. When rotating in a direction (for example, counterclockwise direction), the rotation direction may be distinguished by using a plus or minus sign so as to have a negative value.

uvw/dq変換部21は、電流センサ31,32,33で検出された交流電流Iu,Iv,Iwを、乗算器25で算出された電気角αを用いて座標変換し、d,q軸の実電流値Id,Iqを算出し、減算器14a,14bに出力する。   The uvw / dq conversion unit 21 performs coordinate conversion of the alternating currents Iu, Iv, Iw detected by the current sensors 31, 32, 33 using the electrical angle α calculated by the multiplier 25, and performs d- and q-axis conversions. The actual current values Id and Iq are calculated and output to the subtracters 14a and 14b.

乗算器25は、角度検出値θsとモータMの極対数とを用いてモータMの電気角αを算出する。詳細には、乗算器25は、角度検出値θsに1/極対数を乗じることで、電気角αを算出すればよい。   The multiplier 25 calculates the electrical angle α of the motor M using the detected angle value θs and the number of pole pairs of the motor M. Specifically, the multiplier 25 may calculate the electrical angle α by multiplying the detected angle value θs by 1 / pole pair number.

速度算出部26は、角度検出部20で検出された角度検出値θsを微分し、モータMの回転速度を算出し、速度検出値として減算器11及び乗算器25に出力する。   The speed calculation unit 26 differentiates the detected angle value θs detected by the angle detection unit 20 to calculate the rotation speed of the motor M, and outputs it to the subtractor 11 and the multiplier 25 as a speed detection value.

電流センサ31,32,33は、それぞれ、例えば、ホール素子を利用したホール式の電流センサで構成され、U,V,W相の交流電流Iu,Iv,Iwを検出する。   Each of the current sensors 31, 32, and 33 is configured by, for example, a Hall-type current sensor using a Hall element, and detects U, V, and W-phase AC currents Iu, Iv, and Iw.

以上が制御装置1の基本構成であり、速度検出値が目標速度に追従するように、モータMがフィードバック制御される。   The above is the basic configuration of the control device 1, and the motor M is feedback-controlled so that the detected speed value follows the target speed.

推定部22は、検出誤差を含む角度検出値θs(実回転角度)をモータMの駆動制御に用いることで発生するトルク検出値τd(実出力トルク)の周期的な変動から検出誤差を推定する。   The estimation unit 22 estimates the detection error from the periodic fluctuation of the torque detection value τd (actual output torque) generated by using the angle detection value θs (actual rotation angle) including the detection error for driving control of the motor M. .

補償部23は、推定部22により推定された検出誤差に基づいて、角度検出値θsに含まれる検出誤差を補償する。   The compensation unit 23 compensates for the detection error included in the detected angle value θs based on the detection error estimated by the estimation unit 22.

実施の形態1において、制御装置1の動作は、検出誤差を推定する推定フェーズと、推定フェーズで推定された検出誤差を用いて、角度検出値θsに含まれる検出誤差を除去する補償フェーズとに分けられる。推定部22は、推定フェーズで動作し、補償部23は、補償フェーズで動作する。   In the first embodiment, the control device 1 operates in an estimation phase for estimating the detection error and a compensation phase for removing the detection error included in the angle detection value θs using the detection error estimated in the estimation phase. Divided. The estimation unit 22 operates in the estimation phase, and the compensation unit 23 operates in the compensation phase.

<推定フェーズ>
推定フェーズでは、推定部22は、角度検出値θsとトルク検出値τdとの関係を示す運動方程式に、角度検出値θsとトルク検出値τdを入力し、逐次最小二乗法を適用することで、検出誤差を推定する。
<Estimation phase>
In the estimation phase, the estimation unit 22 inputs the angle detection value θs and the torque detection value τd to the equation of motion indicating the relationship between the angle detection value θs and the torque detection value τd, and sequentially applies the least square method, Estimate the detection error.

式(1)は、推定フェーズで用いられる運動方程式である。   Equation (1) is an equation of motion used in the estimation phase.

Figure 2018023203
Figure 2018023203

θs:検出誤差を含む角度検出値
θ:角度検出値の真値
τd:トルク検出値
J:モータMの慣性モーメント
N:レゾルバの倍角数
Δc:検出誤差のコサイン成分の誤差ゲイン
Δs:検出誤差のサイン成分の誤差ゲイン
ここで、角度検出値θsは、下記の式(2)で表される。
θs: Angle detection value including detection error θ: True value of angle detection value τd: Torque detection value J: Moment of inertia of motor M N: Resolver multiple angle Δc: Error gain of cosine component of detection error Δs: Detection error The error gain of the sine component Here, the detected angle value θs is expressed by the following equation (2).

Figure 2018023203
Figure 2018023203

式(2)において、右辺第1項は真値θを示し、右辺の第2項と第3項とは、検出誤差を示す。   In Expression (2), the first term on the right side indicates the true value θ, and the second and third terms on the right side indicate detection errors.

トルク検出部19は、レゾルバで構成されている。レゾルバで検出される検出誤差は、モータMの回転角度に応じて周期的に変動する特性を持つ。詳細には、検出誤差は、レゾルバの倍角数をN(Nは自然数)とした場合、cos(Nθ)とsin(Nθ)とを一次結合した数式で表される。したがって、検出誤差は、式(2)の第2項と第3項とに示すような誤差関数(Δc・cos(Nθ)+Δs・sin(Nθ))で表すことができる。この式から分かるように、誤差関数は、モータMが1/N回転する間に360度変化する特性を持つ。なお、倍角数Nは、レゾルバの仕様から事前に設定された値が採用できる。   The torque detector 19 is configured by a resolver. The detection error detected by the resolver has a characteristic that varies periodically according to the rotation angle of the motor M. Specifically, the detection error is expressed by a mathematical expression in which cos (Nθ) and sin (Nθ) are linearly combined, where N is the doubler number of the resolver (N is a natural number). Therefore, the detection error can be expressed by an error function (Δc · cos (Nθ) + Δs · sin (Nθ)) as shown in the second and third terms of the equation (2). As can be seen from this equation, the error function has a characteristic of changing 360 degrees while the motor M rotates 1 / N. As the multiple N, a value set in advance from the resolver specification can be adopted.

一方、角度検出値θsとトルク検出値τdとは、回転系の運動方程式:Jθs’’=τd+Δτで表すことができる。但し、ΔτはJθs’’で示す角度検出値θsに基づくモータMの出力トルクとトルク検出値τdとのトルク差である。なお、θs’’に検出誤差が含まれていないならば、Δτ=0となる。数式内に示す「・」は記載の制約上、本文中では、「’」で表している。「・」は1階微分を示し、「・・」は2階微分を示す。   On the other hand, the detected angle value θs and the detected torque value τd can be expressed by the equation of motion of the rotating system: Jθs ″ = τd + Δτ. However, Δτ is a torque difference between the output torque of the motor M and the detected torque value τd based on the detected angle value θs indicated by Jθs ″. If θs ″ does not include a detection error, Δτ = 0. “·” Shown in the formula is represented by “′” in the text due to the limitation of the description. “·” Indicates the first derivative, and “··” indicates the second derivative.

この回転系の運動方程式に式(2)を代入してトルク差Δτを表すと、式(1)が得られる。   Expression (1) is obtained by substituting Expression (2) into the equation of motion of this rotating system to express the torque difference Δτ.

式(1)を、誤差ゲインΔc,Δsについて整理すると、式(3)が得られる。   When formula (1) is arranged with respect to error gains Δc and Δs, formula (3) is obtained.

Figure 2018023203
Figure 2018023203

推定フェーズでは、同時に検出された角度検出値θsとトルク検出値τdとを式(3)の左辺に入力し、逐次最小二乗法を適用し、誤差ゲインΔc,Δsを推定する。   In the estimation phase, the detected angle value θs and the detected torque value τd detected at the same time are input to the left side of Equation (3), and the error gains Δc and Δs are estimated by sequentially applying the least square method.

逐次最小二乗法では、式(4)に示すように、変数zと、変数yと、変数Rとを用いて、推定パラメータP(ハット)を繰り返し計算することで、誤差ゲインΔc,Δsを決定する。なお、数式中に示す「∧」は推定値であることを示す記号であり、本文中では記載の制約上、(ハット)と表す。 The sequential least square method, as shown in Equation (4), and the variable z n, a variable y n, by using the variable R n, by calculating repeatedly estimated parameter P n (hat), error gain Δc , Δs. In addition, “数 式” shown in the mathematical expression is a symbol indicating an estimated value, and is expressed as (hat) in the text due to the limitation of description.

Figure 2018023203
Figure 2018023203

ここで、推定パラメータP(ハット)は、式(5)で表され、変数z、真値θに対応する変数θ、変数y、変数Rは、それぞれ、式(6),(7),(8),(9)で表される。 Here, the estimation parameter P n (hat) is expressed by the equation (5), and the variable θ n , the variable y n , and the variable R n corresponding to the variable z n and the true value θ are respectively expressed by the equations (6), It is represented by (7), (8), (9).

Figure 2018023203
Figure 2018023203

添え字のnは、n番目に算出されたデータであることを示すインデックスであり、1以上の整数である。   The subscript n is an index indicating the nth calculated data, and is an integer of 1 or more.

式(5)に示すように、推定パラメータP(ハット)は、推定対象となる誤差ゲインΔc,Δsを示す2行1列の行列である。 As shown in Expression (5), the estimation parameter P n (hat) is a matrix of 2 rows and 1 column indicating the error gains Δc n and Δs n to be estimated.

式(6)に示すように、変数zは、状態変数と称される変数であり、2行1列の行列で表される。式(6)において、1行目は、式(3)において、右辺第1項のΔcに乗じられた括弧内の数式を示し、2行目は、式(3)において、右辺第2項のΔsに乗じられた括弧内の数式を示す。但し、式(6)では、式(3)のθは、θ→θ(ハット)で表されている。 As shown in Expression (6), the variable z n is a variable called a state variable, and is represented by a matrix of 2 rows and 1 column. In Expression (6), the first line shows an expression in parentheses multiplied by Δc of the first term on the right side in Expression (3), and the second line shows the second term on the right side in Expression (3). A mathematical expression in parentheses multiplied by Δs is shown. However, in Expression (6), θ in Expression (3) is expressed as θ → θ n (hat).

式(7)に示すように、変数θ(ハット)は、式(2)において、右辺第1項のθをθ→θ(ハット)と表し、右辺第2項及び第3項のcos及びsinの括弧内のθをθ→θn−1(ハット)と表し、θs→θs(k+n)と表し、Δc→Δcn−1、Δs→Δsn−1と表したものである。逐次最小二乗法では、n個のデータ群を1セットとして推定パラメータP(ハット)を算出する処理を、複数サイクル繰り返すことにより、推定パラメータPを推定する。したがって、角度検出値θs(k+n)のkは、サイクル数を特定するためのインデックスを表す。例えば、角度検出値θs(k+1)は、kサイクル目の1番目の角度検出値を表す。この場合、角度検出値θs(k)の値として、k−1サイクル目までに得られたθsを用いればよいので、k−1サイクル目までの推定に用いられた(k−1)・n個の角度検出値θsの値をメモリに保存しておく必要がない。よって、逐次最小二乗法はメモリ消費量を抑制できる。このことは、トルク検出値τd(k+n)も同じである。 As shown in Expression (7), the variable θ n (hat) is expressed by θ in the first term on the right side as θ → θ n (hat) in Equation (2), and cos in the second and third terms on the right side. And θ in the parentheses of sin are expressed as θ → θ n-1 (hat), expressed as θs → θs (k + n), and expressed as Δc → Δc n−1 and Δs → Δs n−1 . In the successive least squares method, the estimation parameter P n is estimated by repeating the process of calculating the estimation parameter P n (hat) using n data groups as one set by a plurality of cycles. Therefore, k of the detected angle value θs (k + n) represents an index for specifying the number of cycles. For example, the detected angle value θs (k + 1) represents the first detected angle value in the kth cycle. In this case, as the value of the detected angle value θs (k), θs obtained up to the (k−1) th cycle may be used, and (k−1) · n used for the estimation up to the (k−1) th cycle. It is not necessary to store the value of the detected angle value θs in the memory. Therefore, the successive least square method can suppress memory consumption. This also applies to the torque detection value τd (k + n).

式(8)に示すように変数yは、式(3)の左辺のθs’’をθs’’→θs’’(k+n)と表し、式(3)の左辺のτdをτd→τd(k+n)で表したものである。 The variable y n as shown in Equation (8) represents 'a [theta] s' Equation (3) left side of [theta] s of '' → [theta] s '' and (k + n), the left side of .tau.d the .tau.d → .tau.d of formula (3) ( k + n).

式(9)に示すように変数Rは、変数Rn−1と、変数zと、を用いて表される行列式である。式(9)において、Iは単位行列を示し、Tは転置行列を示す。 As shown in Expression (9), the variable R n is a determinant expressed using the variable R n−1 and the variable z n . In Expression (9), I represents a unit matrix, and T represents a transposed matrix.

図2は、推定部22における処理の流れを示すブロック線図である。まず、推定部22は、角度検出値θs(k+n)及びトルク検出値τd(k+n)が入力されると、式(7)を用いて変数θ(ハット)を算出する(ブロック216)。ここで、角度検出値θs(k+n)とトルク検出値τd(k+n)とはサンプリング周期Tsで順次に入力される。 FIG. 2 is a block diagram showing the flow of processing in the estimation unit 22. First, when the detected angle value θs (k + n) and the detected torque value τd (k + n) are input, the estimating unit 22 calculates a variable θ n (hat) using Expression (7) (block 216). Here, the detected angle value θs (k + n) and the detected torque value τd (k + n) are sequentially input at the sampling period Ts.

なお、1回目の処理では、式(7)の右辺のΔcn−1,Δsn−1、θn−1(ハット)が未知である。そこで、推定部22は、Δcn−1,Δsn−1,θ(ハット)に事前に設定された初期値(Δc,Δs,θ(ハット))を入力すればよい。事前に設定された初期値(Δc,Δs,θ(ハット))としては、推定される値を見越して、その値に近い値を採用すればよい。また、2回目以降のブロック216では、推定部22は、ブロック215で算出された推定パラメータP(ハット)=[Δc Δs]を[Δcn−1 Δsn−1]として、式(7)に入力すればよい。 In the first process, Δc n−1 , Δs n−1 , and θ n−1 (hat) on the right side of Expression (7) are unknown. Therefore, the estimation unit 22 may input initial values (Δc 0 , Δs 0 , θ 0 (hat)) set in advance in Δc n−1 , Δs n−1 , θ n (hat). As an initial value (Δc 0 , Δs 0 , θ 0 (hat)) set in advance, a value close to that value may be adopted in anticipation of an estimated value. Further, in the second and subsequent blocks 216, the estimation unit 22 sets the estimation parameter P n (hat) = [Δc n Δs n ] calculated in the block 215 to [Δc n−1 Δs n−1 ] and the expression ( 7).

次に、推定部22は、ブロック216で算出されたθ(ハット)を1階微分してθ’(ハット)を算出し(ブロック217)、θ(ハット)を2階微分してθ’’(ハット)を算出し(ブロック218)、θ(ハット)に1/zを乗じ、θn−1(ハット)を算出する(ブロック219)。 Next, the estimation unit 22 calculates θ n ′ (hat) by first-order differentiation of θ n (hat) calculated in block 216 (block 217), and second-order differentiation of θ n (hat). θ n ″ (hat) is calculated (block 218), and θ n (hat) is multiplied by 1 / z to calculate θ n−1 (hat) (block 219).

なお、1回目の式(7)の処理では、θn−1(ハット)として初期値が用いられるので、ブロック219の処理は省略される。ブロック217における2(z−1)/Ts(z+1)は、1階微分を示す離散伝達関数である。ブロック218における2(z−1)/Ts(z+1)は、2階微分の離散伝達関数である。Tsはサンプリング周期を表す。 In the first processing of Expression (7), the initial value is used as θ n−1 (hat), and therefore the processing of block 219 is omitted. 2 (z−1) / Ts (z + 1) in the block 217 is a discrete transfer function indicating the first derivative. 2 2 (z−1) 2 / Ts 2 (z + 1) 2 in block 218 is a discrete transfer function of second order differentiation. Ts represents a sampling period.

次に、推定部22は、θ’’(ハット)と、θ’(ハット)と、θ(ハット)とを式(6)に入力し、変数zを算出する(ブロック214)。 Then, the estimation unit 22, theta n '' and (hat), theta n 'and (hat), and theta n (hat) into the Formula (6), to calculate the variable z n (block 214) .

上記の処理と並行して、推定部22は、式(8)を用いて変数yを算出する処理を行う(ブロック213)。 In parallel with the above processing, the estimation unit 22 performs a process of calculating the variable y n using Equation (8) (block 213).

ブロック213の前処理として、推定部22は、トルク検出値τd(k+n)に「1/J」を乗じてτd(k+n)/Jを算出する処理(ブロック211)と、角度検出値θs(k+n)を2階微分し、θs’’(k+n)を算出する処理(ブロック212)とを行う。   As a pre-processing of the block 213, the estimation unit 22 calculates the τd (k + n) / J by multiplying the torque detection value τd (k + n) by “1 / J” (block 211), and the angle detection value θs (k + n). ) Is second-order differentiated to calculate θs ″ (k + n) (block 212).

次に、推定部22は、ブロック214で得られた変数zと、前回求めた変数Rn−1とを式(9)に入力し、変数Rを算出する(ブロック215)。なお、1回目の処理では、式(9)のRn−1が未知である。そこで、推定部22は、Rn−1に事前に設定された初期値(R)を入力すればよい。事前に設定された初期値(R)としては、推定される値を見越して、その値に近い値を採用すればよい。 Next, the estimation unit 22 inputs the variable z n obtained in block 214 and the previously obtained variable R n−1 into equation (9), and calculates the variable R n (block 215). In the first process, R n−1 in Equation (9) is unknown. Therefore, the estimation unit 22 may input an initial value (R 0 ) set in advance to R n−1 . As an initial value (R 0 ) set in advance, a value close to that value may be adopted in anticipation of the estimated value.

次に、推定部22は、ブロック213で算出された変数yとブロック214で算出された変数zと、前回求めた推定パラメータPn−1(ハット)とを式(4)に入力し、推定パラメータP(ハット)=[Δc Δs]を算出する(ブロック215)。なお、1回目の処理では、推定パラメータPn−1が未知である。そこで、推定部22は、推定パラメータPn−1に事前に設定された初期値(P=[Δc Δs])を入力すればよい。 Next, the estimation unit 22 inputs the variable y n calculated in the block 213, the variable z n calculated in the block 214, and the estimation parameter P n−1 (hat) obtained in the previous time into the equation (4). Then, the estimation parameter P n (hat) = [Δc n Δs n ] is calculated (block 215). In the first process, the estimation parameter P n−1 is unknown. Therefore, the estimation unit 22 may input an initial value (P 0 = [Δc 0 Δs 0 ]) set in advance as the estimation parameter P n−1 .

上記の逐次最小二乗法の処理を繰り返すことで、最初、適当に初期値を与えた誤差ゲインΔc,Δsが徐々に真値に収束していく。なお、逐次最小二乗法の処理を繰り返す回数としては、誤差ゲインΔc,Δsが収束することが見込まれる回数が採用されればよい。 By repeating the process of the successive least squares method, first, the error gains Δc n and Δs n given appropriate initial values gradually converge to true values. As the number of times of repeating the process of the successive least square method, the number of times that the error gains Δc n and Δs n are expected to converge may be adopted.

誤差ゲインΔc,Δsが推定されると、推定部22は、この誤差ゲインΔc,Δsを式(2)に入力し、θ−θs=Δc・cos(Nθ)+Δs・sin(Nθ))と変形することで検出誤差θc(=θ−θs)を求める。そして、推定部22は、確定した検出誤差θcと角度検出値θsとの対応関係を示す誤差テーブル302(対応情報)を生成する。 When the error gains Δc n and Δs n are estimated, the estimation unit 22 inputs the error gains Δc n and Δs n into the equation (2), and θ−θs = Δc · cos (Nθ) + Δs · sin (Nθ )) To obtain a detection error θc (= θ−θs). Then, the estimation unit 22 generates an error table 302 (corresponding information) indicating the correspondence between the determined detection error θc and the detected angle value θs.

図3は、誤差テーブル302の説明図である。図3において、グラフ301は、検出誤差θcを示す誤差関数のグラフであり、縦軸はθcを示し、横軸はθsを示している。グラフ301において、検出誤差θcは、θc=0を中心に、角度検出値θsに応じて周期的に一定の振幅で変動していることが分かる。   FIG. 3 is an explanatory diagram of the error table 302. In FIG. 3, a graph 301 is a graph of an error function indicating the detection error θc, with the vertical axis indicating θc and the horizontal axis indicating θs. In the graph 301, it can be seen that the detection error θc fluctuates periodically with a constant amplitude according to the detected angle value θs, with θc = 0 as the center.

誤差テーブル302は、(θs1,θc1)、(θs2,θc2)、・・・というように、複数の角度検出値θsと、検出誤差θcとを対応付けて記憶する。推定部22は、複数の代表的な角度検出値θsを検出誤差θcを示すグラフ301に示す誤差関数に入力することで、複数の代表的な検出誤差θcを算出し、誤差テーブル302を生成すればよい。推定部22は、誤差テーブル302を生成すると、推定フェーズを終了する。   The error table 302 stores a plurality of detected angle values θs and detected errors θc in association with each other as (θs1, θc1), (θs2, θc2),. The estimation unit 22 inputs a plurality of representative angle detection values θs into an error function shown in the graph 301 indicating the detection error θc, thereby calculating a plurality of representative detection errors θc and generating an error table 302. That's fine. When the estimation unit 22 generates the error table 302, the estimation phase ends.

<補償フェーズ>
図1に参照を戻す。推定フェーズが終了すると、制御装置1は、推定フェーズで得られた誤差テーブル302を用いて補償フェーズを実行する。
<Compensation phase>
Returning to FIG. When the estimation phase ends, the control device 1 executes the compensation phase using the error table 302 obtained in the estimation phase.

補償フェーズでは、まず、補償部23に角度検出値θsがサンプリング周期Tsで入力される。なお、補償フェーズでは、トルク検出値τdは用いられないので、トルク検出部19は出力トルクを検出しない。   In the compensation phase, first, the angle detection value θs is input to the compensation unit 23 at the sampling period Ts. In the compensation phase, since the torque detection value τd is not used, the torque detector 19 does not detect the output torque.

補償部23は、入力された角度検出値θsに対応する検出誤差θcを推定部22が生成した誤差テーブル302を参照して決定し、決定した検出誤差θcにマイナス1を乗じ、誤差補償値(−θc)を算出する。なお、誤差テーブル302に入力された角度検出値θsが登録されていなければ、補償部23は、誤差テーブル302を線形補完することにより、入力された角度検出値θsに対応する検出誤差θcを決定すればよい。   The compensation unit 23 determines a detection error θc corresponding to the input angle detection value θs with reference to the error table 302 generated by the estimation unit 22, and multiplies the determined detection error θc by minus 1 to obtain an error compensation value ( -Θc) is calculated. If the detected angle value θs input to the error table 302 is not registered, the compensating unit 23 linearly complements the error table 302 to determine the detected error θc corresponding to the input detected angle value θs. do it.

次に、加算器24は、補償部23から出力された誤差補償値(−θc)を角度検出値θsに加算することで、真値θ(=θs−θc)を算出する。速度算出部26は、算出された真値θを用いて速度検出値を算出する。以後、制御装置1は、真値θを用いてモータMを速度制御する。   Next, the adder 24 calculates the true value θ (= θs−θc) by adding the error compensation value (−θc) output from the compensation unit 23 to the detected angle value θs. The speed calculation unit 26 calculates a speed detection value using the calculated true value θ. Thereafter, the control device 1 controls the speed of the motor M using the true value θ.

このように、実施の形態1の制御装置1によれば、角度検出値θsとトルク検出値τdとの関係を示す運動方程式(式(1))に角度検出値θsとトルク検出値τdとを入力することで、検出誤差θcが推定される。ここで、周期的に変動する検出誤差θcを含んだ角度検出値θsをモータMの駆動制御に用いた場合、トルク検出値τdには、検出誤差θcと同じ周期で、検出誤差θcの大きさに応じた脈動が発生する。そのため、角度検出値θsとトルク検出値τdとが同時に分かれば、角度検出値θsに含まれる検出誤差θcを正確に推定できる。また、レゾルバの検出誤差θcは、図3のグラフ301に示すように、角度検出値θsに応じて周期的に変動する三角関数で表される。よって、本態様は、式(1)の運動方程式に角度検出値θsとトルク検出値τdとを入力し、逐次最小二乗法を適用して、誤差ゲインΔc,Δsを推定することが可能となり、検出誤差θcを正確に推定できる。   Thus, according to the control device 1 of the first embodiment, the angle detection value θs and the torque detection value τd are added to the equation of motion (formula (1)) indicating the relationship between the angle detection value θs and the torque detection value τd. By inputting, the detection error θc is estimated. Here, when an angle detection value θs including a periodically varying detection error θc is used for driving control of the motor M, the torque detection value τd has the same period as the detection error θc and the magnitude of the detection error θc. The pulsation according to is generated. Therefore, if the detected angle value θs and the detected torque value τd are known at the same time, the detection error θc included in the detected angle value θs can be accurately estimated. Further, the resolver detection error θc is represented by a trigonometric function that periodically varies in accordance with the detected angle value θs, as shown in a graph 301 of FIG. Therefore, according to this aspect, it is possible to estimate the error gains Δc and Δs by inputting the angle detection value θs and the torque detection value τd to the equation of motion of the equation (1) and sequentially applying the least square method. The detection error θc can be accurately estimated.

(実施の形態2)
図4は、本発明の実施の形態2に係る制御装置1Aの構成を示すブロック図である。実施の形態1の制御装置1Aは、トルク検出部19に代えて、トルク推定部27を備えたことを特徴とする。なお、実施の形態2において実施の形態1と同一の構成要素には同一の符号を付し、説明を省く。
(Embodiment 2)
FIG. 4 is a block diagram showing a configuration of a control device 1A according to Embodiment 2 of the present invention. The control device 1A according to the first embodiment includes a torque estimation unit 27 instead of the torque detection unit 19. In the second embodiment, the same components as those in the first embodiment are denoted by the same reference numerals and description thereof is omitted.

トルク推定部27は、uvw/dq変換部21により算出された実電流値Id,Iqをを用いて、トルク検出値τdを推定する。   The torque estimation unit 27 estimates the torque detection value τd using the actual current values Id and Iq calculated by the uvw / dq conversion unit 21.

図5は、トルク推定部27に注目したブロック図である。ここでは、モータMがブラシレスモータの一例である永久磁石式同期電動機であるものとする。この場合、トルク推定部27は、図5に示すように、式(10)を用いてトルク検出値τdを推定できる。   FIG. 5 is a block diagram focusing on the torque estimation unit 27. Here, it is assumed that the motor M is a permanent magnet type synchronous motor which is an example of a brushless motor. In this case, the torque estimation unit 27 can estimate the detected torque value τd using the equation (10) as shown in FIG.

τd=Pa(ψaIq+1/2(Lq−Ld)IdIq) (10)
Pa:モータMの極対数
ψa:モータMの鎖交磁束
Ld:モータMのd軸のインダクタンス
Lq:モータMのq軸のインダクタンス
なお、極対数Pa、鎖交磁束ψa、インダクタンスLd,LqはモータMの仕様に基づく既知の値を持つ。ここでは、式(10)が用いられたが、トルク推定部27は、モータMの種類に応じて異なる式を用いてトルク検出値τdを推定すればよい。例えば、トルク推定部27は、実電流値Idに所定の係数を乗じた値をトルク検出値τdとして推定してもよい。
τd = Pa (ψaIq + 1/2 (Lq−Ld) IdIq) (10)
Pa: number of pole pairs of motor M ψa: linkage flux of motor M Ld: inductance of d axis of motor M Lq: inductance of q axis of motor M Note that the number of pole pairs Pa, linkage flux ψa, and inductances Ld and Lq are motors It has a known value based on the specification of M. Here, the equation (10) is used, but the torque estimation unit 27 may estimate the detected torque value τd using a different equation depending on the type of the motor M. For example, the torque estimation unit 27 may estimate a value obtained by multiplying the actual current value Id by a predetermined coefficient as the torque detection value τd.

推定フェーズでは、トルク推定部27により推定されたトルク検出値τdを用いて、実施の形態1と同様に検出誤差θcが推定される。   In the estimation phase, the detection error θc is estimated using the torque detection value τd estimated by the torque estimation unit 27 as in the first embodiment.

このように、実施の形態2に係る制御装置1Aによれば、トルク推定部27によりトルク検出値τdが推定されている。ここで、トルク推定部27は、例えば、CPU等のプロセッサにより構成されている。また、トルク推定部27は、既存の電流センサ31,32,33を用いてトルク検出値τdを推定できる。そのため、制御装置1Aは、専用の計測機械を用いてトルク検出値τdを検出する必要がない。よって、制御装置1Aは、装置のコスト及び規模を抑制できる。   Thus, according to the control device 1A according to the second embodiment, the torque estimation value τd is estimated by the torque estimation unit 27. Here, the torque estimation part 27 is comprised by processors, such as CPU, for example. The torque estimation unit 27 can estimate the torque detection value τd using the existing current sensors 31, 32, and 33. Therefore, the control apparatus 1A does not need to detect the torque detection value τd using a dedicated measuring machine. Therefore, 1 A of control apparatuses can suppress the cost and scale of an apparatus.

(変形例1)
実施の形態1では、逐次最小二乗法を用いて検出誤差θcが推定されていたが、本発明はこれに限定されず、最小二乗法を用いて検出誤差θcを推定してもよい。
(Modification 1)
In the first embodiment, the detection error θc is estimated using the successive least square method, but the present invention is not limited to this, and the detection error θc may be estimated using the least square method.

(変形例2)
実施の形態1では、推定フェーズにおいて、最終的に誤差テーブル302を生成するとして説明したが、本発明はこれに限定されず、最終的に誤差関数を生成してもよい。この場合、補償部23は、角度検出値θsを誤差関数に入力して検出誤差θcを決定すればよい。
(Modification 2)
In the first embodiment, the error table 302 is finally generated in the estimation phase. However, the present invention is not limited to this, and an error function may be finally generated. In this case, the compensation unit 23 may determine the detection error θc by inputting the angle detection value θs into the error function.

(変形例3)
実施の形態1では、推定フェーズと補償フェーズとに分けて処理が行われていたが、本発明はこれに限定されず、両フェーズを分けることなく検出誤差θcの推定及び補償をリアルタイムに行ってもよい。
(Modification 3)
In the first embodiment, the processing is performed separately in the estimation phase and the compensation phase, but the present invention is not limited to this, and the estimation and compensation of the detection error θc is performed in real time without separating both phases. Also good.

この場合、推定部22は、トルク検出値τdと角度検出値θsとが入力される都度、式(1)の運動方程式を用いて誤差ゲインΔc,Δsを求め、検出誤差θcを求めればよい。そして、補償部23は、算出された検出誤差θcを用いて角度検出値θsを補償すればよい。この場合、モータMの制御回数が増大するにつれて、検出誤差θcの補償精度を高めることができる。   In this case, each time the torque detection value τd and the angle detection value θs are input, the estimation unit 22 calculates the error gains Δc and Δs using the equation of motion of the equation (1), and the detection error θc may be obtained. Then, the compensation unit 23 may compensate the angle detection value θs using the calculated detection error θc. In this case, the compensation accuracy of the detection error θc can be increased as the number of times of control of the motor M increases.

(変形例4)
実施の形態1では、角度検出部20としてレゾルバが採用されたが、本発明はこれに限定されず、モータMの回転子の回転角度に応じて検出誤差θcが周期的に変動する特性を持つ角度検出器であれば、どのような角度検出器が採用されてもよい。
(Modification 4)
In the first embodiment, the resolver is employed as the angle detection unit 20, but the present invention is not limited to this, and the detection error θc has a characteristic that periodically varies according to the rotation angle of the rotor of the motor M. Any angle detector may be adopted as long as it is an angle detector.

1,1A 制御装置
11 減算器
12 速度制御部
13 電流指令生成部
14a,14b 減算器
15 電流制御部
16 dq/uvw変換部
17 インバータ
19 トルク検出部
20 角度検出部
21 uvw/dq変換部
22 推定部
23 補償部
24 加算器
25 乗算器
26 速度算出部
27 トルク推定部
31,32,33 電流センサ
301 グラフ
302 誤差テーブル
1, 1A Controller 11 Subtractor 12 Speed controller 13 Current command generator 14a, 14b Subtractor 15 Current controller 16 dq / uvw converter 17 Inverter 19 Torque detector 20 Angle detector 21 uvw / dq converter 22 Estimation Unit 23 Compensator 24 Adder 25 Multiplier 26 Speed calculator 27 Torque estimator 31, 32, 33 Current sensor 301 Graph 302 Error table

Claims (6)

電動機の制御装置であって、
前記電動機の回転子の回転角度に応じて周期的に変動する検出誤差と前記回転角度の真値とを含む前記回転子の実回転角度を検出する角度検出部と、
前記電動機の実出力トルクを検出するトルク検出部と、
前記実回転角度を駆動制御に用いることで発生する前記実出力トルクの周期的な変動から前記検出誤差を推定する推定部と、
前記推定された検出誤差に基づいて、前記実回転角度に含まれる検出誤差を補償する補償部とを備える電動機の制御装置。
A control device for an electric motor,
An angle detection unit for detecting an actual rotation angle of the rotor including a detection error periodically changing according to a rotation angle of the rotor of the electric motor and a true value of the rotation angle;
A torque detector for detecting an actual output torque of the electric motor;
An estimation unit that estimates the detection error from a periodic variation of the actual output torque generated by using the actual rotation angle for drive control;
An electric motor control device comprising: a compensation unit that compensates for a detection error included in the actual rotation angle based on the estimated detection error.
前記推定部は、前記実回転角度と前記実出力トルクとの関係を示す運動方程式に、前記実回転角度と前記実出力トルクとを入力することで、前記検出誤差を推定する請求項1記載の電動機の制御装置。   The said estimation part estimates the said detection error by inputting the said actual rotation angle and the said actual output torque into the equation of motion which shows the relationship between the said actual rotation angle and the said actual output torque. Electric motor control device. 前記実回転角度は、前記真値を変数とする三角関数に誤差ゲインを乗じた誤差関数と、前記真値との和で表され、
前記推定部は、複数の前記実回転角度と複数の前記実出力トルクとを前記運動方程式に入力し、最小二乗法によって、前記誤差ゲインを決定することにより、前記検出誤差を推定する請求項2記載の電動機の制御装置。
The actual rotation angle is represented by a sum of an error function obtained by multiplying a trigonometric function having the true value as a variable by an error gain, and the true value,
3. The estimation unit estimates the detection error by inputting a plurality of actual rotation angles and a plurality of actual output torques to the equation of motion, and determining the error gain by a least square method. The motor control device described.
前記推定部は、前記最小二乗法によって決定された誤差ゲインで表された前記誤差関数から、複数の回転角度と複数の検出誤差とを対応付けた対応情報を生成し、
前記補償部は、前記実回転角度に対応する検出誤差を前記対応情報から決定し、決定した検出誤差を用いて前記実回転角度を補償する請求項3記載の電動機の制御装置。
The estimation unit generates correspondence information in which a plurality of rotation angles and a plurality of detection errors are associated with each other from the error function represented by the error gain determined by the least square method.
The motor control device according to claim 3, wherein the compensation unit determines a detection error corresponding to the actual rotation angle from the correspondence information, and compensates the actual rotation angle using the determined detection error.
前記電動機に流れる電流を検出する電流検出部を更に備え、
前記トルク検出部は、前記検出された電流に基づいて、前記実出力トルクを算出する請求項1〜4のいずれかに記載の電動機の制御装置。
A current detection unit for detecting a current flowing through the electric motor;
The motor control apparatus according to claim 1, wherein the torque detection unit calculates the actual output torque based on the detected current.
前記角度検出部は、レゾルバで構成される請求項1〜5のいずれかに記載の電動機の制御装置。   The motor control device according to claim 1, wherein the angle detection unit is configured by a resolver.
JP2016152023A 2016-08-02 2016-08-02 Motor control device Active JP6664288B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016152023A JP6664288B2 (en) 2016-08-02 2016-08-02 Motor control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016152023A JP6664288B2 (en) 2016-08-02 2016-08-02 Motor control device

Publications (2)

Publication Number Publication Date
JP2018023203A true JP2018023203A (en) 2018-02-08
JP6664288B2 JP6664288B2 (en) 2020-03-13

Family

ID=61164687

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016152023A Active JP6664288B2 (en) 2016-08-02 2016-08-02 Motor control device

Country Status (1)

Country Link
JP (1) JP6664288B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20200113589A (en) * 2019-03-26 2020-10-07 엘에스일렉트릭(주) Control system for induction motor
JP2021032849A (en) * 2019-08-29 2021-03-01 トヨタ自動車株式会社 Resolver device

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008256486A (en) * 2007-04-04 2008-10-23 Aisan Ind Co Ltd Resolver
JP2012039730A (en) * 2010-08-05 2012-02-23 Aisin Aw Co Ltd Control constant determination method and motor controller
WO2013076839A1 (en) * 2011-11-24 2013-05-30 トヨタ自動車株式会社 Rotational-angle detection device and electric power-steering device provided with rotational-angle detection device

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008256486A (en) * 2007-04-04 2008-10-23 Aisan Ind Co Ltd Resolver
JP2012039730A (en) * 2010-08-05 2012-02-23 Aisin Aw Co Ltd Control constant determination method and motor controller
WO2013076839A1 (en) * 2011-11-24 2013-05-30 トヨタ自動車株式会社 Rotational-angle detection device and electric power-steering device provided with rotational-angle detection device

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20200113589A (en) * 2019-03-26 2020-10-07 엘에스일렉트릭(주) Control system for induction motor
KR102608297B1 (en) 2019-03-26 2023-11-29 엘에스일렉트릭(주) Control system for induction motor
JP2021032849A (en) * 2019-08-29 2021-03-01 トヨタ自動車株式会社 Resolver device
JP7173706B2 (en) 2019-08-29 2022-11-16 トヨタ自動車株式会社 Resolver device

Also Published As

Publication number Publication date
JP6664288B2 (en) 2020-03-13

Similar Documents

Publication Publication Date Title
CN104052361B (en) Electric machine control system to compensate torque pulsation
JP5952332B2 (en) Sensorless vector control device for induction motor
JP5916343B2 (en) Motor control device and motor control method
JP4519864B2 (en) AC rotating machine electrical constant measuring method and AC rotating machine control apparatus used for carrying out this measuring method
JP6361450B2 (en) Induction motor control device
JP2011061910A (en) Motor driver and method for removing torque ripples
JP2012231615A (en) Motor drive controller and motor drive method
JP6664288B2 (en) Motor control device
JP6183554B2 (en) Periodic disturbance automatic suppression device
JP2010035352A (en) Device for estimating rotor position of synchronous electric motor
JP2008206330A (en) Device and method for estimating magnetic pole position of synchronous electric motor
JP2004048933A (en) Control unit for dc brushless motor
JP3920750B2 (en) DC brushless motor control device
JP5298367B2 (en) Induction motor control device
JP2011239518A (en) Method and apparatus for estimating position and speed of rotor of stepping motor
JP2006158046A (en) Sensorless control method and apparatus of ac electric motor
JP5534991B2 (en) Control device for synchronous motor
JP5326284B2 (en) Control device for synchronous motor
JP6591794B2 (en) Induction machine power converter, second-order time constant measuring method and speed control method
JP5312179B2 (en) DC brushless motor control device
CN107528517B (en) Method for controlling rotating electric machine
JP7311759B2 (en) Rotating machine control device
JP6108114B2 (en) Control device for permanent magnet type synchronous motor
JP5996485B2 (en) Motor drive control device
JP2009165333A (en) Controller of synchronous electric motor

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20181203

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20191009

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20191015

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191029

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: 20200212

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200218

R150 Certificate of patent or registration of utility model

Ref document number: 6664288

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150