JP7203176B1 - Rotating machine control device and vehicle drive device - Google Patents
Rotating machine control device and vehicle drive device Download PDFInfo
- Publication number
- JP7203176B1 JP7203176B1 JP2021175140A JP2021175140A JP7203176B1 JP 7203176 B1 JP7203176 B1 JP 7203176B1 JP 2021175140 A JP2021175140 A JP 2021175140A JP 2021175140 A JP2021175140 A JP 2021175140A JP 7203176 B1 JP7203176 B1 JP 7203176B1
- Authority
- JP
- Japan
- Prior art keywords
- value
- torque
- arithmetic processing
- rotating machine
- specific
- 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.)
- Active
Links
- 238000012545 processing Methods 0.000 claims abstract description 179
- 230000005856 abnormality Effects 0.000 claims abstract description 168
- 238000004364 calculation method Methods 0.000 claims abstract description 130
- 238000000034 method Methods 0.000 claims abstract description 47
- 230000008569 process Effects 0.000 claims abstract description 40
- 230000008859 change Effects 0.000 claims description 83
- 238000012795 verification Methods 0.000 claims description 58
- 238000012937 correction Methods 0.000 claims description 35
- 230000005540 biological transmission Effects 0.000 claims description 8
- 230000007246 mechanism Effects 0.000 claims description 7
- 238000001914 filtration Methods 0.000 claims description 5
- ATJFFYVFTNAWJD-UHFFFAOYSA-N Tin Chemical compound [Sn] ATJFFYVFTNAWJD-UHFFFAOYSA-N 0.000 description 26
- 230000001133 acceleration Effects 0.000 description 17
- 238000001514 detection method Methods 0.000 description 16
- 238000010586 diagram Methods 0.000 description 15
- 238000004804 winding Methods 0.000 description 11
- 230000002159 abnormal effect Effects 0.000 description 7
- 238000006243 chemical reaction Methods 0.000 description 5
- 238000012360 testing method Methods 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- PXHVJJICTQNCMI-UHFFFAOYSA-N Nickel Chemical compound [Ni] PXHVJJICTQNCMI-UHFFFAOYSA-N 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 101150046268 BCK1 gene Proteins 0.000 description 1
- UFHFLCQGNIYNRP-UHFFFAOYSA-N Hydrogen Chemical compound [H][H] UFHFLCQGNIYNRP-UHFFFAOYSA-N 0.000 description 1
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical group [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 1
- 101100433987 Latilactobacillus sakei subsp. sakei (strain 23K) ackA1 gene Proteins 0.000 description 1
- HBBGRARXTFLTSG-UHFFFAOYSA-N Lithium ion Chemical compound [Li+] HBBGRARXTFLTSG-UHFFFAOYSA-N 0.000 description 1
- 239000003990 capacitor Substances 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 230000005669 field effect Effects 0.000 description 1
- 230000004907 flux Effects 0.000 description 1
- 229910052739 hydrogen Inorganic materials 0.000 description 1
- 239000001257 hydrogen Substances 0.000 description 1
- 229910001416 lithium ion Inorganic materials 0.000 description 1
- 229910044991 metal oxide Inorganic materials 0.000 description 1
- 150000004706 metal oxides Chemical class 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 229910052759 nickel Inorganic materials 0.000 description 1
- 238000010248 power generation Methods 0.000 description 1
- 238000009789 rate limiting process Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000003313 weakening effect Effects 0.000 description 1
Images
Landscapes
- Control Of Electric Motors In General (AREA)
Abstract
【課題】回転機に要求されている要求トルクからトルク指令値までの算出過程の異常を検出することができる回転機の制御装置及び車両用駆動装置を提供する。【解決手段】要求トルクからトルク指令値までの算出過程において、入力トルク値に対して特定の演算処理を行って出力トルク値を算出するトルク指令値算出部と、特定の演算処理の入力トルク値及び出力トルク値に基づいて、特定の演算処理の動作異常を判定し、トルク指令値算出部の動作異常を判定する異常判定部と、を備えた回転機の制御装置。【選択図】図3A control device for a rotating machine and a vehicle driving device capable of detecting an abnormality in a calculation process from a required torque required for the rotating machine to a torque command value are provided. A torque command value calculator that calculates an output torque value by performing specific arithmetic processing on an input torque value in the process of calculating from a required torque to a torque command value, and an input torque value for the specific arithmetic processing. and an abnormality determination unit that determines an operation abnormality of a specific arithmetic processing based on the output torque value, and determines an operation abnormality of the torque command value calculation unit. [Selection drawing] Fig. 3
Description
本願は、回転機の制御装置及び車両用駆動装置に関するものである。 The present application relates to a control device for a rotary machine and a vehicle drive device.
特許文献1には、車両駆動用のモータにおいて、モータで発生するトルク性能に基づいて異常を検出する従来技術が開示されている。特許文献1の技術では、モータが駆動されている際にモータで発生している実トルクを推定する実トルク推定手段と、トルク指令値と実トルク推定手段で推定された実トルク推定値とに基づいて、モータの異常を検出する異常検出手段とを備えることで、モータの回転速度及び動作温度に基づいて異常を検出する。この従来技術は、トルク差が生じた際のモータの異常を検出できない問題を解決している。
Japanese Unexamined Patent Application Publication No. 2002-100000 discloses a conventional technique for detecting an abnormality in a motor for driving a vehicle based on the torque performance generated by the motor. In the technique of
特許文献2は、電気エンジンによって付与されるトルクの監視方法と、車両の加速又は制動における問題の検出を開示している。特許文献2の技術では、特にトルクの設定点の変化が速い段階において、運転可能なエンジントルクを監視する方法を提案している。特許文献2の技術は、過剰な制動又は加速、不十分な制動又は加速を検出するために、電気エンジンによって付与されるトルクの推定値又は測定値を下限値又は上限値と比較する。 US Pat. No. 5,300,003 discloses a method for monitoring the torque imparted by an electric engine and detecting problems in vehicle acceleration or braking. The technique of Patent Document 2 proposes a method of monitoring the drivable engine torque, especially during the phase of rapid change of the torque set point. The technique of US Pat. No. 5,900,000 compares an estimated or measured torque imparted by an electric engine to a lower or upper limit to detect excessive braking or acceleration, or insufficient braking or acceleration.
しかしながら、上記のような従来の回転機の制御装置は、モータの実トルク又はトルク推定値を基準にトルクの異常を検出したり監視したりするようにしていたので、要求トルクからトルク指令値を演算する過程の異常を検知することができない問題があった。 However, since the conventional control device for a rotating machine as described above detects or monitors an abnormality in the torque based on the actual torque or the estimated torque value of the motor, the torque command value is calculated from the required torque. There was a problem that it was not possible to detect anomalies in the process of calculation.
そこで、本願は、回転機に要求されている要求トルクからトルク指令値までの算出過程の異常を検出することができる回転機の制御装置及び車両用駆動装置を提供することを目的とする。 SUMMARY OF THE INVENTION Accordingly, it is an object of the present application to provide a control device for a rotating machine and a vehicle driving device capable of detecting an abnormality in the calculation process from the required torque required for the rotating machine to the torque command value.
本願に係る回転機の制御装置は、
回転機に要求される出力トルクである要求トルクに基づいてトルク指令値を算出するトルク指令値算出部と、
前記トルク指令値に基づいて、前記回転機を制御する回転機制御部と、
前記トルク指令値算出部の動作異常を判定し、判定結果を出力する異常判定部と、を備え、
前記トルク指令値算出部は、前記要求トルクから前記トルク指令値までの算出過程において、入力トルク値に対して特定の演算処理を行って出力トルク値を算出し、単数種類又は複数種類の前記特定の演算処理を行い、
前記異常判定部は、前記単数種類の前記特定の演算処理について、又は前記複数種類の前記特定の演算処理の動作異常のそれぞれについて、前記特定の演算処理の前記入力トルク値及び前記出力トルク値に基づいて、前記特定の演算処理の動作異常を判定し、前記単数種類又は前記複数種類の前記特定の演算処理の動作異常の判定結果に基づいて、前記トルク指令値算出部の動作異常を判定するものである。
A control device for a rotating machine according to the present application includes:
a torque command value calculation unit that calculates a torque command value based on the required torque, which is the output torque required for the rotating machine;
a rotating machine control unit that controls the rotating machine based on the torque command value;
an abnormality determination unit that determines an operation abnormality of the torque command value calculation unit and outputs a determination result,
The torque command value calculation unit calculates an output torque value by performing specific arithmetic processing on an input torque value in the process of calculating from the required torque to the torque command value, and calculates one or more of the specific torque values. performs the arithmetic processing of
The abnormality determination unit determines the input torque value and the output torque value of the specific arithmetic processing for the single type of the specific arithmetic processing or for each of the plurality of types of operation abnormalities of the specific arithmetic processing. Based on the operation abnormality of the specific arithmetic processing is determined, and based on the determination result of the operation abnormality of the specific operation processing of the single type or the plurality of types, the operation abnormality of the torque command value calculation unit is determined It is.
また、本願に係る車両用駆動装置は、
上記の回転機の制御装置と、
前記回転機と、
前記回転機の駆動力を車両の車輪に伝達する駆動力伝達機構と、を備えたものである。
Further, the vehicle drive device according to the present application is
a control device for the rotating machine;
the rotating machine;
and a driving force transmission mechanism for transmitting the driving force of the rotating machine to the wheels of the vehicle.
本願に係る回転機の制御装置及び車両用駆動装置によれば、要求トルクからトルク指令値までの算出過程において、入力トルク値に対して特定の演算処理を行って出力トルク値を算出する単数種類又は複数種類の特定の演算処理のそれぞれについて、入力トルク値及び出力トルク値に基づいて、特定の演算処理の動作異常を判定することができる。よって、要求トルクからトルク指令値までの算出過程の異常を検出することができ、回転機の制御装置の動作の信頼性を高めることができる。 According to the rotating machine control device and the vehicle drive device according to the present application, in the process of calculating from the required torque to the torque command value, there is a single type in which the output torque value is calculated by performing specific arithmetic processing on the input torque value. Alternatively, for each of a plurality of types of specific arithmetic processing, it is possible to determine whether the specific arithmetic processing is malfunctioning based on the input torque value and the output torque value. Therefore, an abnormality in the calculation process from the required torque to the torque command value can be detected, and the reliability of the operation of the controller for the rotating machine can be enhanced.
1.実施の形態1
以下、実施の形態1に係る回転機の制御装置30(以下、単に、制御装置30と称す)について図面を参照して説明する。図1は、回転機1、インバータ4、及び制御装置30等の概略構成図である。
1.
A
1-1.回転機1
回転機1は、複数相の巻線を設けたステータとロータと、を有している。本実施の形態では、3相の巻線Cu、Cv、Cwが設けられる。なお、複数組の3相の巻線が設けられてもよい。ロータには、永久磁石が設けられている。なお、ロータには、界磁巻線、又は鉄心が設けられている。本実施の形態では、図2に示すように、回転機1は、車両の車輪の駆動力源とされており、回転機1は、動力伝達機構50を介して、車輪51に連結されている。例えば、動力伝達機構50は、ギヤ等を有する変速機である。
1-1.
The
回転機1は、ロータの回転角度に応じた電気信号を出力する回転センサ16を備えている。回転センサ16は、ホール素子、エンコーダ、又はレゾルバ等とされる。回転センサ16の出力信号は、制御装置30に入力される。
The
1-2.インバータ20
インバータ20は、直流電源10と3相巻線Cu、Cv、Cwとの間で電力変換を行う電力変換器であり、複数のスイッチング素子を有している。インバータ20は、直流電源10の正極側に接続される正極側のスイッチング素子と直流電源10の負極側に接続される負極側のスイッチング素子とが直列接続された直列回路を、3相各相の巻線に対応して3セット設けている。そして、各相の直列回路における正極側のスイッチング素子と負極側のスイッチング素子との接続点が、対応する相の巻線に接続されている。
1-2.
The
スイッチング素子には、IGBT(Insulated Gate Bipolar Transistor)、又はMOSFET(Metal Oxide Semiconductor Field Effect Transistor)等が用いられる。各スイッチング素子のゲート端子は、制御装置に接続されている。各スイッチング素子は、制御装置30から出力される制御信号によりオン又はオフされる。
An IGBT (Insulated Gate Bipolar Transistor), a MOSFET (Metal Oxide Semiconductor Field Effect Transistor), or the like is used as the switching element. A gate terminal of each switching element is connected to a control device. Each switching element is turned on or off by a control signal output from
電流センサ17は、各相の巻線に流れる電流に応じた電気信号を出力する。電流センサ17は、各相の直列回路と巻線とをつなぐ各相の電線上、又は各相の直列回路に備えられている。電流センサ17の出力信号は、制御装置30に入力される。
The
直流電源10には、充放電可能な蓄電装置(例えば、リチウムイオン電池、ニッケル水素電池、電気二重層キャパシタ)が用いられる。なお、直流電源10には、直流電圧を昇圧したり降圧したりする直流電力変換器であるDC-DCコンバータが設けられてもよい。
A chargeable/dischargeable power storage device (for example, a lithium ion battery, a nickel hydrogen battery, an electric double layer capacitor) is used for the
1-3.制御装置30
制御装置30は、インバータ20を介して回転機1を制御する。図3に示すように、制御装置30は、トルク指令値算出部31、回転機制御部32、及び異常判定部33等を備えている。制御装置30の各機能は、制御装置30が備えた処理回路により実現される。具体的には、制御装置30は、図4に示すように、処理回路として、CPU(Central Processing Unit)等の演算処理装置90(コンピュータ)、演算処理装置90とデータのやり取りする記憶装置91、演算処理装置90に外部の信号を入力する入力回路92、演算処理装置90から外部に信号を出力する出力回路93、及び通信回路94等を備えている。
1-3.
演算処理装置90として、ASIC(Application Specific Integrated Circuit)、IC(Integrated Circuit)、DSP(Digital Signal Processor)、FPGA(Field Programmable Gate Array)、各種の論理回路、及び各種の信号処理回路等が備えられてもよい。また、演算処理装置90として、同じ種類のもの又は異なる種類のものが複数備えられ、各処理が分担して実行されてもよい。記憶装置91として、演算処理装置90からデータを読み出し及び書き込みが可能に構成されたRAM(Random Access Memory)、演算処理装置90からデータを読み出し可能に構成されたROM(Read Only Memory)等が備えられている。入力回路92は、電流センサ17、回転センサ16等の各種のセンサ、スイッチが接続され、これらセンサ、スイッチの出力信号を演算処理装置90に入力するA/D変換器等を備えている。出力回路93は、スイッチング素子をオンオフ駆動するゲート駆動回路等の電気負荷が接続され、これら電気負荷に演算処理装置90から制御信号を出力する駆動回路等を備えている。通信回路94は、車両制御装置95等の外部の制御装置と接続され、通信を行う。
As the
そして、制御装置30が備える図3の各制御部31~33等の各機能は、演算処理装置90が、ROM等の記憶装置91に記憶されたソフトウェア(プログラム)を実行し、記憶装置91、入力回路92、出力回路93、及び通信回路94等の制御装置30の他のハードウェアと協働することにより実現される。なお、各制御部31~33等が用いる上限変化率TRH及び下限変化率TRL等の設定データは、ソフトウェア(プログラム)の一部として、ROM等の記憶装置91に記憶されている。以下、制御装置30の各機能について詳細に説明する。
3 provided in the
1-3-1.回転機制御部32
回転機制御部32は、後述するトルク指令値算出部31により算出されるトルク指令値Toに基づいて、回転機1を制御する。本実施の形態では、回転機制御部32は、電圧指令値算出部321、PWM制御部322、及び回転検出部323を備えている。
1-3-1. Rotating
The rotating
回転検出部323は、電気角でのロータの磁極位置θ(ロータの回転角度θ)及び回転速度ωを検出する。本実施の形態では、回転検出部323は、回転センサ16の出力信号に基づいて、ロータの磁極位置θ(回転角度θ)及び回転速度ωを検出する。本実施の形態では、磁極位置は、ロータに設けられた永久磁石のN極の向きに設定される。なお、回転検出部323は、電流指令値に高調波成分を重畳することによって得られる電流情報等に基づいて、回転センサを用いずに、回転角度(磁極位置)を推定するように構成されてもよい(いわゆる、センサレス方式)。
The
電圧指令値算出部321は、トルク指令値Toに基づいて、3相の巻線に印加する3相の電圧指令値を演算する。本実施の形態では、電圧指令値算出部321は、トルク指令値Toに基づいて電流指令値を算出し、電流指令値及び電流検出値に基づく電流フィードバック制御により、電圧指令値を算出する。なお、電圧指令値算出部321は、電流指令値に基づくフィードフォワード制御により電圧指令値を算出してもよい。
The voltage
例えば、d軸及びq軸の回転座標系上で電流を制御するベクトル制御が用いられる。d軸及びq軸の回転座標系は、N極(磁極位置θ)の方向に定めたd軸及びd軸より電気角で90°進んだ方向に定めたq軸からなる2軸の回転座標である。電圧指令値算出部321は、トルク指令値To、回転速度ω、及び直流電圧等に基づいて、d軸の電流指令値及びq軸の電流指令値を算出する。この算出には、最大トルク電流制御、弱め界磁制御、Id=0制御などの公知のベクトル制御方法が用いられる。
For example, vector control is used to control the current on a d-axis and q-axis rotating coordinate system. The rotating coordinate system of the d-axis and the q-axis is a two-axis rotating coordinate system consisting of the d-axis set in the direction of the N pole (magnetic pole position θ) and the q-axis set in the
電圧指令値算出部321は、電流センサ17の出力信号に基づいて、3相の巻線に流れる3相の電流を検出する。電圧指令値算出部321は、3相の電流検出値を、磁極位置θ(回転角度θ)に基づいて、公知の3相2相変換及び回転座標変換を行って、d軸の電流検出値及びq軸の電流検出値に変換する。そして、電圧指令値算出部321は、d軸及びq軸の電流指令値及びd軸及びq軸の電流検出値に基づいて、公知の電流フィードバック制御を行い、d軸の電圧指令値及びq軸の電圧指令値を算出する。そして、電圧指令値算出部321は、d軸及びq軸の電圧指令値を、磁極位置θ(回転角度θ)に基づいて、公知の固定座標変換及び2相3相変換を行って、3相の電圧指令値を算出する。3相の電圧指令値に、公知の各種の変調が加えられてもよい。
Based on the output signal of the
そして、PWM制御部322は、3相の電圧指令値に基づいて、PWM制御によりインバータ20の複数のスイッチング素子をオンオフ制御する。PWM制御として、公知のキャリア波比較PWM又は空間ベクトルPWMが用いられる。
Then,
1-3-2.トルク指令値算出部31及び異常判定部33
<トルク指令値算出部31>
トルク指令値算出部31は、回転機1に要求される出力トルクである要求トルクTrに基づいてトルク指令値Toを算出する。本実施の形態では、要求トルクTrは、車両制御装置95から伝達される。そのため、要求トルクTrは、車輪の駆動のために、回転機1に要求される出力トルクになる。なお、要求トルクTrは、各種の装置の駆動のため、又は発電のために、回転機1に要求される出力トルクとされてもよい。
1-3-2. Torque command
<Torque
The torque
トルク指令値算出部31は、要求トルクTrからトルク指令値Toまでの算出過程において、入力トルク値Tinに対して特定の演算処理を行って出力トルク値Toutを算出する。本実施の形態では、トルク指令値算出部31は、単数種類の特定の演算処理を行う。
The torque
本実施の形態では、トルク指令値算出部31は、特定の演算処理として、入力トルク値Tinに対して、上限変化率TRH及び下限変化率TRLにより時間変化率を上下限制限する変化率制限処理を行った値を、出力トルク値Toutとして算出する。本実施の形態では、特定の演算処理の入力トルク値Tinは、要求トルクTrになり、出力トルク値Toutは、トルク指令値Toになる。
In the present embodiment, the torque command
この変化率制限処理により、要求トルクTrが急変した場合に、トルク指令値Toの時間変化率が上下限制限され、トルク指令値Toの急変が抑制され、車両の振動が抑制される。 By this change rate limiting process, when the required torque Tr suddenly changes, the time rate of change of the torque command value To is limited by upper and lower limits, thereby suppressing the sudden change of the torque command value To and suppressing the vibration of the vehicle.
トルク指令値算出部31は、特定演算部311として、変化率演算部3111、上下限変化率設定部3112、及び変化率制限部3113を備えている。変化率演算部3111は、入力された入力トルク値Tinの時間変化率を演算する。上下限変化率設定部3112は、上限変化率TRH及び下限変化率TRLを設定する。上限変化率TRH及び下限変化率TRLは、ROM等の記憶装置91に予め設定されている。これらは、車両の振動を抑制できるような値に予め設定されている。
The torque
変化率制限部3113は、入力トルク値Tinを出力トルク値Toutとして設定した場合に、出力トルク値Toutの時間変化率が上限変化率TRHよりも大きくなる場合は、出力トルク値Toutの時間変化率が上限変化率TRHになるように、入力トルク値Tinを補正し、補正後の入力トルク値Tinを出力トルク値Toutとして設定する。また、変化率制限部3113は、入力トルク値Tinを出力トルク値Toutとして設定した場合に、出力トルク値Toutの時間変化率が下限変化率TRLよりも小さくなる場合は、出力トルク値Toutの時間変化率が下限変化率TRLになるように、入力トルク値Tinを補正し、補正後の入力トルク値Tinを出力トルク値Toutとして設定する。一方、変化率制限部3113は、入力トルク値Tinを出力トルク値Toutとして設定した場合に、出力トルク値Toutの時間変化率が上限変化率TRHよりも小さく、下限変化率TRLよりも大きくなる場合は、入力トルク値Tinをそのまま出力トルク値Toutとして設定する。
If the input torque value Tin is set as the output torque value Tout and the time rate of change of the output torque value Tout is greater than the upper limit rate of change TRH, the
<異常判定部33>
異常判定部33は、トルク指令値算出部31の動作異常を判定し、判定結果を出力する。異常判定部33は、単数種類の特定の演算処理について、特定の演算処理の入力トルク値Tin及び出力トルク値Toutに基づいて、特定の演算処理の動作異常を判定し、単数種類の特定の演算処理の動作異常の判定結果に基づいて、トルク指令値算出部31の動作異常を判定する。
<
The
本実施の形態では、異常判定部33(検算部3311)は、特定の演算処理と同等の演算結果が得られ、特定の演算処理と異なる演算を行う検算用の演算処理を用い、特定の演算処理に入力される入力トルク値Tinに対して、検算用の演算処理を行って検算トルク値Tckを算出する。そして、異常判定部33(判定部3312)は、検算トルク値Tckと出力トルク値Toutとを比較して特定の演算処理の動作異常を判定し、判定結果Fを出力する。ここで、同等の演算結果とは、特定の演算処理の動作が正常な場合に、動作異常と判定されないような演算結果である。本実施の形態では、同等の演算結果とは、検算用の演算処理が、特定の演算処理の正常動作時に、出力トルク値Toutと検算トルク値Tckとの偏差の絶対値が異常判定値以下になる処理を行うことに相当する。 In the present embodiment, the abnormality determination unit 33 (calculation unit 3311) obtains a calculation result equivalent to that of a specific calculation process, and uses calculation processing for verification that performs calculation different from the specific calculation process. Arithmetic processing for verification is performed on the input torque value Tin input to the process to calculate a verification torque value Tck. Then, the abnormality determination unit 33 (determination unit 3312) compares the check torque value Tck and the output torque value Tout to determine an operation abnormality of a specific arithmetic process, and outputs a determination result F. Here, the equivalent calculation result is a calculation result that is not judged to be abnormal in operation when the operation of a specific calculation process is normal. In the present embodiment, the equivalent calculation result means that the absolute value of the deviation between the output torque value Tout and the verification torque value Tck is equal to or less than the abnormality determination value when the specific calculation process is operating normally. It is equivalent to performing a process that becomes
本実施の形態では、上述したように、特定の演算処理は、変化率制限処理とされている。異常判定部33は、検算用の演算処理として、入力トルク値Tinの時間変化率を上限変化率TRHにより上限制限するような上限値TVHを算出し、トルク値の時間変化率を下限変化率TRLにより下限制限するような下限値TVLを算出し、入力トルク値Tinを上限値TVHにより上限制限し、下限値TVLにより下限制限した値を、検算トルク値Tckとして算出する。
In the present embodiment, as described above, the specific arithmetic processing is the change rate limiting processing. As a calculation process for verification, the
異常判定部33(検算部3311)は、制限値演算部33111、上下限変化率設定部33112、及び上下限制限部33113を備えている。上下限変化率設定部33112は、上限変化率TRH及び下限変化率TRLを設定する。これらは、トルク指令値算出部31の上下限変化率設定部3112により設定される値と同じ値であり、ROM等の記憶装置91に予め設定されている。制限値演算部33111は、入力トルク値Tin、及び上限変化率TRH及び下限変化率TRLに基づいて、入力トルク値Tinの時間変化率を上限変化率TRHにより上限制限するような上限値TVHを算出し、トルク値の時間変化率を下限変化率TRLにより下限制限するような下限値TVLを算出する。上下限制限部33113は、入力トルク値Tinが上限値TVHよりも大きくなる場合は、上限値TVHを検算トルク値Tckとして設定し、入力トルク値Tinが下限値TVLよりも小さくなる場合は、下限値TVLを検算トルク値Tckとして設定し、入力トルク値Tinが上限値TVHよりも小さく、下限値TVLよりも大きくなる場合は、入力トルク値Tinをそのまま検算トルク値Tckとして設定する。
The abnormality determination unit 33 (calculation unit 3311 ) includes a limit
判定部3312は、検算トルク値Tckと出力トルク値Toutとを比較して特定の演算処理の動作異常を判定し、判定結果Fを出力する。判定部3312は、出力トルク値Toutが検算トルク値Tckから逸脱したと判定した場合に、特定の演算処理の動作異常を判定する。例えば、判定部3312は、出力トルク値Toutと検算トルク値Tckとの偏差の絶対値が、異常判定値よりも大きくなった場合は、特定の演算処理の動作異常が発生したと判定し、偏差の絶対値が、異常判定値以下である場合は、特定の演算処理の動作異常が発生していないと判定する。偏差の絶対値が異常判定値よりも大きくなってからの経過時間、動作異常が判定される頻度等が考慮されてもよい。
Determining
2.実施の形態2
次に、実施の形態2に係る制御装置30について説明する。上記の実施の形態1と同様の構成部分は説明を省略する。本実施の形態に係る制御装置30の基本的な構成は実施の形態1と同様であるが、トルク指令値算出部31において直列に接続された複数種類の特定の演算処理が行われる点が実施の形態1と異なる。図5に、トルク指令値算出部31及び異常判定部33のブロック図を示す。
2. Embodiment 2
Next, the
本実施の形態では、トルク指令値算出部31は、2種類の特定の演算処理を行う。第1の特定の演算処理は、実施の形態1と同様の変化率制限処理である。第2の特定の演算処理は、以下で説明するバンドストップフィルタ処理である。異常判定部33は、2種類の特定の演算処理のそれぞれに対応した2種類の検算用の演算処理を行う。
In the present embodiment, the torque
図5に示すように、トルク指令値算出部31の第1の特定演算部311が、第1の入力トルク値Tin1(要求トルクTr)に対して、実施の形態1と同様の第1の特定の演算処理(変化率制限処理)を行って、第1の出力トルク値Tout1を算出する。異常判定部33の第1の検算部3311が、実施の形態1と同様の、第1の検算用の演算処理(検算用の変化率制限処理)を行って、第1の検算トルク値Tck1を算出し、異常判定部33の第1の判定部3312が、第1の出力トルク値Tout1と第1の検算トルク値Tck1とに基づいて、実施の形態1と同様に第1の特定の演算処理の動作異常の判定処理を行って、第1の判定結果F1を出力する。
As shown in FIG. 5, the first
<第2の特定の演算処理>
トルク指令値算出部31(第2の特定演算部312)は、第2の特定の演算処理として、第2の入力トルク値Tin2に対して、特定の周波数帯の成分を減衰するバンドストップフィルタ処理を行った値を、第2の出力トルク値Tout2として算出する。第2の出力トルク値Tout2が、トルク指令値Toとして設定される。
<Second Specific Arithmetic Processing>
The torque command value calculation unit 31 (second specific calculation unit 312) performs band-stop filter processing for attenuating components in a specific frequency band on the second input torque value Tin2 as second specific calculation processing. is calculated as the second output torque value Tout2. The second output torque value Tout2 is set as the torque command value To.
本実施の形態では、特定の周波数帯は、回転機1の回転軸が接続された動力伝達機構50に生じる機械的な共振周波数帯に設定されている。なお、特定の周波数帯は、任意の周波数に設定されてもよく、複数の周波数帯に設定されてもよく、動作状態に応じて変化されてもよい。
In this embodiment, the specific frequency band is set to a mechanical resonance frequency band generated in
例えば、バンドストップフィルタ処理として、次式の演算処理が行われる。
ここで、zは、Z変換の演算子を表し、z-1は、入力された信号を、1演算周期だけ遅らせて出力する処理を行う。a1、a2、a3、b0、b1、b2、b3は、減衰周波数が、特定の周波数帯になるように設定される係数である。 Here, z represents a Z-transform operator, and z −1 performs a process of delaying an input signal by one operation period and outputting it. a1, a2, a3, b0, b1, b2, and b3 are coefficients set so that the attenuation frequency is in a specific frequency band.
式(1)を、離散時間の演算処理で表すと次式になり、次式の演算処理が実装される。
ここで、(n)は、今回の演算周期で算出される値であることを表し、(n-1)は、前回の演算周期で算出された値であることを表し、(n-k)は、k回前の演算周期で算出された値であることを表している。 Here, (n) represents the value calculated in the current calculation cycle, (n-1) represents the value calculated in the previous calculation cycle, and (nk) indicates that it is a value calculated in the calculation cycle k times before.
<第2の検算用の演算処理>
異常判定部33は、第2の検算用の演算処理として、第2の特定の演算処理で用いられる演算式と数学的に等価であるが異なる演算式を用いる。
<Arithmetic processing for second verification>
The
具体的には、異常判定部33(本例では、第2の検算部3321)は、第2の検算用の演算処理として、第2の特定の演算処理に入力される第2の入力トルク値Tin2に対して、第2の特定の演算処理のバンドストップフィルタ処理と数学的に等価であるが異なる演算式を用いた検算用のバンドストップフィルタ処理を行った値を、第2の検算トルク値Tck2として算出する。 Specifically, the abnormality determination unit 33 (in this example, the second verification unit 3321) receives the second input torque value input to the second specific calculation processing as the calculation processing for the second verification. A value obtained by subjecting Tin2 to band-stop filtering for verification using an arithmetic expression that is mathematically equivalent to, but different from, the band-stop filtering of the second specific arithmetic processing is used as a second verification torque value. Calculate as Tck2.
例えば、検算用のバンドストップフィルタ処理として、式(1)の分子及び分母をそれぞれb0で除算して変形した次式の演算処理が行われる。
ack0、ack1、ack2、ack3、bck1、bck2、bck3は、同じ特定の周波数帯になるように、a1、a2、a3、b0、b1、b2、b3に基づいて設定される係数である。式(3)を、離散時間の演算処理で表すと次式になり、次式の演算処理が実装される。
そして、異常判定部33(本例では、第2の判定部3322)は、第2の検算トルク値Tck2と第2の出力トルク値Tout2(トルク指令値To)とを比較して第2の特定の演算処理の動作異常を判定し、第2の判定結果F2を出力する。例えば、第2の判定部3322は、第2の出力トルク値Tout2と第2の検算トルク値Tck2との第2の偏差の絶対値が、第2の異常判定値よりも大きくなった場合は、第2の特定の演算処理の動作異常が発生したと判定し、第2の偏差の絶対値が、第2の異常判定値以下である場合は、第2の特定の演算処理の動作異常が発生していないと判定する。
Then, the abnormality determination unit 33 (in this example, the second determination unit 3322) compares the second verification torque value Tck2 and the second output torque value Tout2 (torque command value To) to determine the second specified value. , and outputs a second determination result F2. For example, when the absolute value of the second deviation between the second output torque value Tout2 and the second verification torque value Tck2 is greater than the second abnormality determination value, the
<総合判定部330>
異常判定部33(本例では、総合判定部330)は、2種類の特定の演算処理のいずれか1つ以上について、動作異常があると判定された場合に、トルク指令値算出部31に動作異常が発生したと総合的に判定し、総合的な判定結果FFを出力する。動作異常があると総合的に判定されてからの経過時間、総合的に動作異常が判定される頻度等が考慮されてもよい。
<
The abnormality determination unit 33 (in this example, the comprehensive determination unit 330) causes the torque command
この構成によれば、直列に接続された複数種類の特定の演算処理にいずれかで動作異常が発生すると、最終演算値であるトルク指令値Toに異常が発生している可能性がある。上記の構成によれば、各特定の演算処理の動作異常を個別に判定することができ、各特定の演算処理の動作異常の判定精度を個別に高めることができる。そして、いずれか1つ以上において動作異常があると判定された場合に、トルク指令値算出部31に動作異常が発生したと判定することで、安全サイドに異常を判定することができる。
According to this configuration, if an operational abnormality occurs in any one of a plurality of types of specific arithmetic processing connected in series, there is a possibility that an abnormality has occurred in the torque command value To, which is the final calculated value. According to the above configuration, the operational abnormality of each specific arithmetic processing can be determined individually, and the accuracy of the operational abnormality determination of each specific arithmetic processing can be improved individually. Then, when it is determined that there is an operational abnormality in one or more of them, it is determined that an operational abnormality has occurred in the torque command
3.実施の形態3
次に、実施の形態3に係る制御装置30について説明する。上記の実施の形態1又は2と同様の構成部分は説明を省略する。本実施の形態に係る制御装置30の基本的な構成は実施の形態1又は2と同様であるが、トルク指令値算出部31において直列に接続された3種類の特定の演算処理が行われる点が実施の形態1又は2と異なる。図6に、トルク指令値算出部31及び異常判定部33のブロック図を示す。
3.
Next, the
本実施の形態では、トルク指令値算出部31は、3種類の特定の演算処理を行う。第1の特定の演算処理は、実施の形態1と同様の変化率制限処理である。第2の特定の演算処理は、実施の形態2と同様のバンドストップフィルタ処理である。第3の特定の演算処理は、以下で説明する加速度反転時補正処理である。異常判定部33は、3種類の特定の演算処理のそれぞれに対応した3種類の検算用の演算処理を行う。
In the present embodiment, the torque
図6に示すように、トルク指令値算出部31の第1の特定演算部311が、第1の入力トルク値Tin1(要求トルクTr)に対して、実施の形態1と同様の第1の特定の演算処理(変化率制限処理)を行って、第1の出力トルク値Tout1を算出する。異常判定部33の第1の検算部3311が、実施の形態1と同様の、第1の検算用の演算処理(検算用の変化率制限処理)を行って、第1の検算トルク値Tck1を算出し、異常判定部33の第1の判定部3312が、第1の出力トルク値Tout1と第1の検算トルク値Tck1とに基づいて、実施の形態1と同様に第1の特定の演算処理の動作異常の判定処理を行って、第1の判定結果F1を出力する。
As shown in FIG. 6, the first
トルク指令値算出部31の第2の特定演算部312が、第2の入力トルク値Tin2(第1の出力トルク値Tout1)に対して、実施の形態2と同様の第2の特定の演算処理(バンドストップフィルタ処理)を行って、第2の出力トルク値Tout2を算出する。異常判定部33の第2の検算部3321が、実施の形態2と同様の、第1の検算用の演算処理(検算用のバンドストップフィルタ処理)を行って、第2の検算トルク値Tck2を算出し、異常判定部33の第2の判定部3322が、第2の出力トルク値Tout2と第2の検算トルク値Tck2とに基づいて、実施の形態2と同様に第2の特定の演算処理の動作異常の判定処理を行って、第2の判定結果F2を出力する。
The second
<第3の特定の演算処理>
トルク指令値算出部31(第3の特定演算部313)は、第3の特定の演算処理として、回転機の回転速度ωの時間変化率α(加速度α)を算出し、回転速度ωの時間変化率α(加速度α)の正負の符号が反転したときに、第3の入力トルク値Tin3(第2の出力トルク値Tout2)に対して加算補正又は減算補正を行った値を、第3の出力トルク値Tout3として算出する。第3の出力トルク値Tout3が、トルク指令値Toとして設定される。
<Third Specific Arithmetic Processing>
The torque command value calculation unit 31 (third specific calculation unit 313) calculates a time change rate α (acceleration α) of the rotation speed ω of the rotating machine as a third specific calculation process, and calculates the time of the rotation speed ω A value obtained by subjecting the third input torque value Tin3 (second output torque value Tout2) to addition correction or subtraction correction when the positive/negative sign of the rate of change α (acceleration α) is inverted is referred to as a third It is calculated as an output torque value Tout3. The third output torque value Tout3 is set as the torque command value To.
回転軸に連結された動力伝達機構50には、ギアのバックラッシュ等の非線形要素が存在する。加速度αの正負の符号が反転すると、バックラッシュの影響が顕著に表れる。よって、トルク指令値Toの加算補正又は減算補正を行うことにより、バックラッシュの影響を低減することができる。
Non-linear elements such as gear backlash are present in the
回転機の回転速度ωは、回転検出部323から取得される。第3の特定演算部313は、回転機の回転速度ωの微分演算を行って、回転速度ωの時間変化率α(加速度α)を算出する。例えば、第3の特定演算部313は、回転機の回転速度ωの単位時間当たりの変化量Δωを単位時間で除算して、回転速度ωの時間変化率α(加速度α)を算出する。
The rotation speed ω of the rotating machine is obtained from the
例えば、加速度αの符号が正から負に反転した場合に、加算補正が行われ、加速度αの符号が負から正に反転した場合に、減算補正が行われる。加算値及び減算値は、バックラッシュの影響を低減できるように設定される。なお、目的によっては、加算補正と減算補正とが逆にされてもよい。 For example, when the sign of the acceleration α is reversed from positive to negative, addition correction is performed, and when the sign of the acceleration α is reversed from negative to positive, subtraction correction is performed. The addition value and subtraction value are set so as to reduce the influence of backlash. Depending on the purpose, addition correction and subtraction correction may be reversed.
<第3の検算用の演算処理>
異常判定部33は、第3の検算用の演算処理として、第3の特定の演算処理で用いられる演算式と数学的に等価であるが異なる演算式を用いる。
<Third Arithmetic Processing for Verification>
The
具体的には、異常判定部33(本例では、第3の検算部3331)は、第3の検算用の演算処理として、第3の特定の演算処理に入力される第3の入力トルク値Tin3に対して、回転機の回転角度θの時間変化率(速度ω)の時間変化率α(加速度α)を算出し、回転角度の時間変化率の時間変化率αの正負の符号が反転したときに、第3の入力トルク値Tin3に加算補正又は減算補正を行った値を、第3の検算トルク値Tck3として算出する。 Specifically, the abnormality determination unit 33 (in this example, the third verification unit 3331) receives the third input torque value input to the third specific calculation processing as the calculation processing for the third verification. For Tin3, the time rate of change α (acceleration α) of the time rate of change (speed ω) of the rotation angle θ of the rotating machine is calculated, and the sign of the time rate of change α of the time rate of change of the rotation angle is reversed. Sometimes, a value obtained by subjecting the third input torque value Tin3 to addition correction or subtraction correction is calculated as the third verification torque value Tck3.
回転機の回転角度θは、回転検出部323から取得される。第3の検算部3331は、回転機の回転角度θの2回の微分演算を行って、回転角度θの時間変化率の時間変化率α(加速度α)を算出する。例えば、第3の検算部3331は、回転機の回転角度θの単位時間当たりの変化量Δθを単位時間で除算して、回転角度の時間変化率ω(速度ω)を算出し、回転角度の時間変化率ωの単位時間当たりの変化量Δωを単位時間で除算して、回転角度の時間変化率の時間変化率α(加速度α)を算出する。
The rotation angle θ of the rotating machine is obtained from the
第3の特定の演算処理と同様に、例えば、加速度αの符号が正から負に反転した場合に、加算補正が行われ、加速度αの符号が負から正に反転した場合に、減算補正が行われる。加算値及び減算値は、バックラッシュの影響を低減できるように設定される。なお、目的によっては、加算補正と減算補正とが逆にされてもよい。 As in the third specific arithmetic processing, for example, when the sign of the acceleration α is reversed from positive to negative, addition correction is performed, and when the sign of the acceleration α is reversed from negative to positive, subtraction correction is performed. done. The addition value and subtraction value are set so as to reduce the influence of backlash. Depending on the purpose, addition correction and subtraction correction may be reversed.
そして、異常判定部33(本例では、第3の判定部3332)は、第3の検算トルク値Tck3と第3の出力トルク値Tout3とを比較して第3の特定の演算処理の動作異常を判定し、第3の判定結果F3を出力する。例えば、第3の判定部3332は、第3の出力トルク値Tout3と第3の検算トルク値Tck3との第3の偏差の絶対値が、第3の異常判定値よりも大きくなった場合は、第3の特定の演算処理の動作異常が発生したと判定し、第3の偏差の絶対値が、第3の異常判定値以下である場合は、第3の特定の演算処理の動作異常が発生していないと判定する。
Then, the abnormality determination unit 33 (in this example, the third determination unit 3332) compares the third verification torque value Tck3 and the third output torque value Tout3 to determine whether the operation of the third specific arithmetic processing is abnormal. is determined, and a third determination result F3 is output. For example, when the absolute value of the third deviation between the third output torque value Tout3 and the third verification torque value Tck3 is greater than the third abnormality determination value, the
<総合判定部330>
異常判定部33(本例では、総合判定部330)は、第1の判定結果F1、第2の判定結果F2、及び第3の判定結果F3に基づいて、3種類の特定の演算処理のいずれか1つ以上について、動作異常があると判定された場合に、トルク指令値算出部31に動作異常が発生したと総合的に判定し、総合的な判定結果FFを出力する。動作異常があると総合的に判定されてからの経過時間、総合的に動作異常が判定される頻度等が考慮されてもよい。
<
Based on the first determination result F1, the second determination result F2, and the third determination result F3, the abnormality determination unit 33 (in this example, the comprehensive determination unit 330) performs any one of three types of specific arithmetic processing. If it is determined that there is an operational abnormality with respect to one or more of them, it is comprehensively determined that an operational abnormality has occurred in the torque command
4.実施の形態4
次に、実施の形態4に係る制御装置30について説明する。上記の実施の形態1、2、又は3と同様の構成部分は説明を省略する。本実施の形態に係る制御装置30の基本的な構成は実施の形態1、2、又は3と同様であるが、トルク指令値算出部31及び異常判定部33の処理が実施の形態1、2、又は3と異なる。図7に、トルク指令値算出部31及び異常判定部33のブロック図を示す。
4.
Next, the
本実施の形態では、トルク指令値算出部31は、1種類の特定の演算処理を行い、異常判定部33は、1種類の特定の演算処理の動作異常を判定する。
In the present embodiment, the torque command
<特定の演算処理>
トルク指令値算出部31(本例では、特定演算部314)は、特定の演算処理として、回転機の回転速度ωに対して特定の周波数帯の成分を抽出するバンドパスフィルタ処理を行って回転速度の振動成分Δωを抽出し、回転速度の振動成分Δωに基づいて、回転速度の振動成分Δωを抑制するトルク補正値ΔTOCを算出し、入力トルク値Tin(要求トルクTr)からトルク補正値ΔTOCを減算した値を、出力トルク値Tout(トルク指令値To)として算出する。回転機の回転速度ωは、回転検出部323から取得される。
<Specific arithmetic processing>
The torque command value calculation unit 31 (in this example, the specific calculation unit 314) performs band-pass filter processing for extracting components in a specific frequency band with respect to the rotational speed ω of the rotating machine as specific calculation processing. A torque correction value ΔTOC for suppressing the rotational speed vibration component Δω is calculated based on the rotational speed vibration component Δω, and the torque correction value ΔTOC is calculated from the input torque value Tin (required torque Tr). is calculated as the output torque value Tout (torque command value To). The rotation speed ω of the rotating machine is obtained from the
実施の形態2と同様に、特定の周波数帯は、回転機1の回転軸が接続された動力伝達機構に生じる機械的な共振周波数帯に設定されている。例えば、トルク指令値算出部31は、回転速度の振動成分Δωに制御ゲイン(正の値)を乗算した値を、トルク補正値ΔTOCとして算出する。
As in the second embodiment, the specific frequency band is set to a mechanical resonance frequency band that occurs in the power transmission mechanism to which the rotating shaft of rotating
回転速度ωに、共振周波数帯等の特定の周波数帯の振動が生じた場合に、バンドパスフィルタ処理により抽出した特定の周波数帯の回転速度の振動成分Δωを抑制するトルク補正値ΔTOCを算出し、トルク指令値Toを補正することで、フィードバック制御により、回転速度の振動を低減することができる。 When vibration in a specific frequency band such as a resonance frequency band occurs in the rotation speed ω, a torque correction value ΔTOC is calculated to suppress the vibration component Δω of the rotation speed in the specific frequency band extracted by band-pass filtering. By correcting the torque command value To, the vibration of the rotation speed can be reduced by feedback control.
<異常判定>
異常判定部33は、特定の演算処理の入力トルク値Tin及び出力トルク値Toutに基づいて、特定の演算処理の動作異常を判定する。
<Abnormal judgment>
The
異常判定部33(本例では、判定部3342)は、特定の演算処理の入力トルク値Tinと出力トルク値Toutとの偏差に、特定の周波数帯の成分を減衰するバンドストップフィルタ処理を行ったフィルタ値に基づいて、特定の演算処理の動作異常を判定し、判定結果Fを出力する。
The abnormality determination unit 33 (
例えば、異常判定部33(判定部3342)は、偏差のフィルタ値の絶対値が、異常判定値よりも大きくなった場合は、特定の演算処理の動作異常が発生したと判定し、偏差のフィルタ値の絶対値が、異常判定値以下である場合は、特定の演算処理の動作異常が発生していないと判定する。偏差のフィルタ値の絶対値が異常判定値よりも大きくなってからの経過時間、動作異常が判定される頻度等が考慮されてもよい。 For example, when the absolute value of the deviation filter value is greater than the abnormality determination value, the abnormality determination unit 33 (determination unit 3342) determines that an operation abnormality of a specific arithmetic processing has occurred, If the absolute value of the value is equal to or less than the abnormality determination value, it is determined that an operational abnormality has not occurred in the specific arithmetic processing. The elapsed time from when the absolute value of the deviation filter value becomes greater than the abnormality determination value, the frequency at which the operation abnormality is determined, and the like may be considered.
このように、特定の演算処理の種類によっては、検算用の演算処理を行わずに、入力トルク値Tinと出力トルク値Toutとに基づいて、動作異常を判定できる。 In this way, depending on the type of specific arithmetic processing, it is possible to determine whether the operation is abnormal based on the input torque value Tin and the output torque value Tout without performing arithmetic processing for verification.
5.実施の形態5
次に、実施の形態5に係る制御装置30について説明する。上記の実施の形態1、2、3、又は4と同様の構成部分は説明を省略する。本実施の形態に係る制御装置30の基本的な構成は実施の形態1、2、3、又は4と同様であるが、トルク指令値算出部31及び異常判定部33の処理が実施の形態1、2、3、又は4と異なる。図8に、トルク指令値算出部31及び異常判定部33のブロック図を示す。
5. Embodiment 5
Next, the
本実施の形態では、トルク指令値算出部31は、直列に接続された2種類の特定の演算処理を行い、異常判定部33は、2種類の特定の演算処理のそれぞれの動作異常を判定する。第1の特定の演算処理は、実施の形態4と同様の回転振動打消し処理である。第2の特定の演算処理は、以下で説明するトルクリプル打消し処理である。
In the present embodiment, the torque command
図8に示すように、トルク指令値算出部31の第1の特定演算部314が、第1の入力トルク値Tin1(要求トルクTr)に対して、実施の形態4と同様の第1の特定の演算処理(回転振動打消し処理)を行って、第1の出力トルク値Tout1を算出する。異常判定部33の第1の判定部3342が、実施の形態4と同様に、第1の特定の演算処理の第1の入力トルク値Tin1及び第1の出力トルク値Tout1に基づいて、第1の特定の演算処理の動作異常の判定処理を行って、第1の判定結果F1を出力する。
As shown in FIG. 8, the first
<第2の特定の演算処理>
トルク指令値算出部31(第2の特定演算部315)は、第2の特定の演算処理として、回転機の回転角度θに基づいて、トルクリプルを低減するトルク補正値ΔTLPを算出し、第2の入力トルク値Tin2(第1の出力トルク値Tout1)からトルク補正値ΔTLPを減算して第2の出力トルク値Tout2を算出する。第2の出力トルク値Tout2が、トルク指令値Toとして設定される。回転機の回転角度θは、回転検出部323から取得される。
<Second Specific Arithmetic Processing>
Torque command value calculation unit 31 (second specific calculation unit 315) calculates a torque correction value ΔTLP for reducing torque ripple based on rotation angle θ of the rotating machine as a second specific calculation process, and performs a second specific calculation process. The second output torque value Tout2 is calculated by subtracting the torque correction value ΔTLP from the input torque value Tin2 (the first output torque value Tout1). The second output torque value Tout2 is set as the torque command value To. The rotation angle θ of the rotating machine is obtained from the
トルクリプル成分は、回転角度θに応じて変化する。第2の特定演算部315は、回転角度θとトルク補正値ΔTLPとの関係が予め設定されたトルク補正値マップを参照し、現在の回転角度θに対応するトルク補正値ΔTLPを算出する。トルク補正値マップは、ROM等の記憶装置91に予め設定されている。
The torque ripple component changes according to the rotation angle θ. The second
<異常判定>
異常判定部33は、第2の特定の演算処理の第2の入力トルク値Tin2及び第2の出力トルク値Tout2に基づいて、第2の特定の演算処理の動作異常を判定する。
<Abnormal judgment>
The
異常判定部33(本例では、第2の判定部3352)は、第2の特定の演算処理の入力トルク値Tin2と第2の出力トルク値Tout2との偏差に基づいて、第2の特定の演算処理の動作異常を判定し、第2の判定結果F2を出力する。 The abnormality determination unit 33 (in this example, the second determination unit 3352) determines the second specific value based on the deviation between the input torque value Tin2 of the second specific arithmetic processing and the second output torque value Tout2. An operation abnormality of arithmetic processing is determined, and a second determination result F2 is output.
例えば、異常判定部33(第2の判定部3352)は、偏差の絶対値が、第2の異常判定値よりも大きくなった場合は、第2の特定の演算処理の動作異常が発生したと判定し、偏差の絶対値が、第2の異常判定値以下である場合は、第2の特定の演算処理の動作異常が発生していないと判定する。偏差の絶対値が第2の異常判定値よりも大きくなってからの経過時間、動作異常が判定される頻度等が考慮されてもよい。第2の異常判定値は、トルク補正値ΔTLPの設定値よりも大きい値に設定される。 For example, when the absolute value of the deviation is greater than the second abnormality determination value, the abnormality determination unit 33 (second determination unit 3352) determines that an operation abnormality has occurred in the second specific arithmetic processing. If the absolute value of the deviation is equal to or less than the second abnormality determination value, it is determined that the operation abnormality of the second specific arithmetic processing has not occurred. The elapsed time from when the absolute value of the deviation becomes larger than the second abnormality determination value, the frequency at which the operation abnormality is determined, and the like may be taken into consideration. The second abnormality determination value is set to a value larger than the set value of the torque correction value ΔTLP.
6.実施の形態6
次に、実施の形態6に係る制御装置30について説明する。上記の実施の形態1、2、3、4、又は5と同様の構成部分は説明を省略する。本実施の形態に係る制御装置30の基本的な構成は実施の形態1、2、3、4、又は5と同様であるが、トルク指令値算出部31及び異常判定部33の処理が実施の形態1、2、3、4、又は5と異なる。図9に、トルク指令値算出部31及び異常判定部33のブロック図を示す。
6.
Next, the
本実施の形態では、トルク指令値算出部31は、直列に接続された5種類の特定の演算処理を行う。実施の形態3の3種類の特定の演算処理と、実施の形態5の2種類の特定の演算処理とが直列に接続されている。
In the present embodiment, the torque
第1の特定演算部311により実行される第1の特定の演算処理は、実施の形態1と同様の変化率制限処理であり、それに対応する動作異常の判定が第1の検算部3311及び第1の判定部3312により実行される。第2の特定演算部312により実行される第2の特定の演算処理は、実施の形態2と同様のバンドストップフィルタ処理であり、それに対応する動作異常の判定が第2の検算部3321及び第1の判定部3322により実行される。第3の特定演算部313により実行される第3の特定の演算処理は、実施の形態4と同様の加速度反転時補正処理であり、それに対応する動作異常の判定が第3の検算部3331及び第3の判定部3332により実行される。第4の特定演算部314により実行される第4の特定の演算処理は、実施の形態5と同様の回転振動打消し処理であり、それに対応する動作異常の判定が第4の判定部3342により実行される。第5の特定演算部315により実行される第5の特定の演算処理は、実施の形態6と同様のトルクリプル打消し処理であり、それに対応する動作異常の判定が第5の判定部3352により実行される。
The first specific calculation processing executed by the first
異常判定部33(トルク推定器3361)は、回転機制御部32から回転機の制御パラメータを取得し、制御パラメータに基づいて、回転機の出力トルクTestを推定する。本実施の形態では、制御パラメータとして、3相の電流検出値Iur、Ivr、Iwr、回転角度θ(磁極位置θ)を取得する。そして、トルク推定器3361は、3相の電流検出値Iur、Ivr、Iwrを、磁極位置θ(回転角度θ)に基づいて、公知の3相2相変換及び回転座標変換を行って、d軸の電流検出値Idr及びq軸の電流検出値Iqrに変換する。トルク推定器3361は、次式の一般的なトルク方程式を用いて、d軸の電流検出値Idr、及びq軸の電流検出値Iqrに基づいて、出力トルクの基本値Testbを推定する。なお、トルク推定器3361は、回転機制御部32から、3相の電流検出値、及び磁極位置θの代わりに、d軸の電流検出値Idr及びq軸の電流検出値Iqrを取得してもよい。
ここで、Pnは、永久磁石の極対数であり、Ψaは、永久磁石による鎖交磁束であり、Ldは、d軸のインダクタンスであり、Lqは、q軸のインダクタンスである。これらには、予め設定された値が用いられる。 Here, Pn is the number of pole pairs of the permanent magnet, Ψa is the magnetic flux linkage by the permanent magnet, Ld is the d-axis inductance, and Lq is the q-axis inductance. Preset values are used for these.
また、トルク推定器3361は、回転速度ω及びトルク指令値Toに基づいて、損失トルクΔTlossを算出する。回転速度ωは、回転角度θの微分演算により算出されてもよいし、回転機制御部32から取得されてもよい。例えば、トルク推定器3361は、回転速度ω、トルク指令値To、及び損失トルクΔTlossの間の関係が予め設定された損失トルクマップを参照し、現在の回転速度ω及び現在のトルク指令値Toに対応する損失トルクΔTlossを算出する。そして、トルク推定器3361は、出力トルクの基本値Testbから損失トルクΔTlossを減算して、出力トルクの推定値Testを算出する。
Also, the
異常判定部33(モータ制御異常判定部3362)は、トルク指令値Toと出力トルクの推定値Testとに基づいて、回転機制御部32の動作異常を判定し、モータ制御の判定結果Fmを出力する。モータ制御異常判定部3362は、出力トルクの推定値Testがトルク指令値Toから逸脱したと判定した場合に、回転機制御部32の動作異常を判定する。例えば、モータ制御異常判定部3362は、出力トルクの推定値Testとトルク指令値Toとの偏差の絶対値が、異常判定値よりも大きくなった場合は、回転機制御部32の動作異常が発生したと判定し、偏差の絶対値が、異常判定値以下である場合は、回転機制御部32の動作異常が発生していないと判定する。偏差の絶対値が異常判定値よりも大きくなってからの経過時間、動作異常が判定される頻度等が考慮されてもよい。
The abnormality determination unit 33 (motor control abnormality determination unit 3362) determines an operation abnormality of the rotating
異常判定部33(総合判定部330)は、第1から第5の判定結果F1からF5、及びモータ制御の判定結果Fmのいずれか1つ以上について、動作異常があると判定された場合に、トルク指令値算出部31及び回転機制御部32に動作異常が発生したと総合的に判定し、総合的な判定結果FFを出力する。動作異常があると総合的に判定されてからの経過時間、総合的に動作異常が判定される頻度等が考慮されてもよい。
When it is determined that one or more of the first to fifth determination results F1 to F5 and the motor control determination result Fm have an operation abnormality, the abnormality determination unit 33 (comprehensive determination unit 330) It comprehensively determines that an operation abnormality has occurred in the torque command
<転用例>
直列に接続される複数種類の特定の演算処理には、各実施の形態で説明した種類以外の特定の演算処理が用いられてもよく、また、任意の種類の特定の演算処理が直列に接続されてもよく、また、各特定の演算処理の処理順番は、任意の順番に設定されてもよい。
<Example of diversion>
A plurality of types of specific arithmetic processing connected in series may use specific arithmetic processing other than the types described in each embodiment, and any type of specific arithmetic processing may be connected in series. Moreover, the processing order of each specific arithmetic processing may be set to an arbitrary order.
本願は、様々な例示的な実施の形態及び実施例が記載されているが、1つ、または複数の実施の形態に記載された様々な特徴、態様、及び機能は特定の実施の形態の適用に限られるのではなく、単独で、または様々な組み合わせで実施の形態に適用可能である。従って、例示されていない無数の変形例が、本願明細書に開示される技術の範囲内において想定される。例えば、少なくとも1つの構成要素を変形する場合、追加する場合または省略する場合、さらには、少なくとも1つの構成要素を抽出し、他の実施の形態の構成要素と組み合わせる場合が含まれるものとする。 While this application describes various exemplary embodiments and examples, various features, aspects, and functions described in one or more embodiments may not apply to particular embodiments. can be applied to the embodiments singly or in various combinations. Accordingly, numerous variations not illustrated are envisioned within the scope of the technology disclosed herein. For example, modification, addition or omission of at least one component, extraction of at least one component, and combination with components of other embodiments shall be included.
1 回転機、30 回転機の制御装置、31 トルク指令値算出部、32 回転機制御部、33 異常判定部、Tck 検算トルク値、Tin 入力トルク値、Tout 出力トルク値、Tr 要求トルク
REFERENCE SIGNS
Claims (11)
前記トルク指令値に基づいて、前記回転機を制御する回転機制御部と、
前記トルク指令値算出部の動作異常を判定し、判定結果を出力する異常判定部と、を備え、
前記トルク指令値算出部は、前記要求トルクから前記トルク指令値までの算出過程において、入力トルク値に対して特定の演算処理を行って出力トルク値を算出し、単数種類又は複数種類の前記特定の演算処理を行い、
前記異常判定部は、前記単数種類の前記特定の演算処理について、又は前記複数種類の前記特定の演算処理の動作異常のそれぞれについて、前記特定の演算処理の前記入力トルク値及び前記出力トルク値に基づいて、前記特定の演算処理の動作異常を判定し、前記単数種類又は前記複数種類の前記特定の演算処理の動作異常の判定結果に基づいて、前記トルク指令値算出部の動作異常を判定する回転機の制御装置。 a torque command value calculation unit that calculates a torque command value based on the required torque, which is the output torque required for the rotating machine;
a rotating machine control unit that controls the rotating machine based on the torque command value;
an abnormality determination unit that determines an operation abnormality of the torque command value calculation unit and outputs a determination result,
The torque command value calculation unit calculates an output torque value by performing specific arithmetic processing on an input torque value in the process of calculating from the required torque to the torque command value, and calculates one or more of the specific torque values. performs the arithmetic processing of
The abnormality determination unit determines the input torque value and the output torque value of the specific arithmetic processing for the single type of the specific arithmetic processing or for each of the plurality of types of operation abnormalities of the specific arithmetic processing. Based on the operation abnormality of the specific arithmetic processing is determined, and based on the determination result of the operation abnormality of the specific operation processing of the single type or the plurality of types, the operation abnormality of the torque command value calculation unit is determined Rotating machine control device.
前記異常判定部は、前記検算用の演算処理として、前記特定の演算処理の前記入力トルク値の時間変化率を前記上限変化率により上限制限するような上限値を算出し、前記入力トルク値の時間変化率を前記下限変化率により下限制限するような下限値を算出し、前記入力トルク値を上限値により上限制限すると共に下限値により下限制限する処理を行った値を、前記検算トルク値として算出する請求項2又は3に記載の回転機の制御装置。 The torque command value calculation unit performs, as the specific arithmetic processing, a value obtained by subjecting the input torque value to change rate limiting processing for limiting the rate of change over time using an upper limit rate of change and a lower limit of rate of change, Calculated as an output torque value,
The abnormality determination unit calculates an upper limit value that limits the time rate of change of the input torque value in the specific calculation process by the upper limit rate of change as the calculation process for verification, and calculates the upper limit value of the input torque value. A lower limit is calculated such that the rate of change over time is lower-limited by the lower-limit rate of change, and the input torque value is upper-limited by the upper-limit value and lower-limited by the lower-limit value. 4. The rotating machine control device according to claim 2 or 3.
前記異常判定部は、前記検算用の演算処理として、前記特定の演算処理の前記入力トルク値に対して、前記特定の演算処理の前記バンドストップフィルタ処理と数学的に等価であるが異なる演算式を用いた検算用のバンドストップフィルタ処理を行った値を、前記検算トルク値として算出する請求項2から4のいずれか一項に記載の回転機の制御装置。 The torque command value calculation unit calculates, as the output torque value, a value obtained by subjecting the input torque value to band-stop filter processing for attenuating a component in a specific frequency band as the specific arithmetic processing,
The abnormality determination unit, as the arithmetic processing for verification, applies an arithmetic expression, which is mathematically equivalent to but different from the band-stop filter processing of the specific arithmetic processing, to the input torque value of the specific arithmetic processing. The controller for a rotating machine according to any one of claims 2 to 4, wherein a value obtained by band-stop filter processing for verification using is calculated as the verification torque value.
前記異常判定部は、前記検算用の演算処理として、前記回転機の回転角度の時間変化率の時間変化率を算出し、前記回転角度の時間変化率の時間変化率の正負の符号が反転したときに、前記特定の演算処理の前記入力トルク値に加算補正又は減算補正を行った値を、前記検算トルク値として算出する請求項2から5のいずれか一項に記載の回転機の制御装置。 The torque command value calculation unit calculates a time rate of change of the rotational speed of the rotating machine as the specific arithmetic processing, and calculates the input torque value when the sign of the time rate of change of the rotational speed is inverted. Calculate a value obtained by performing addition correction or subtraction correction to the output torque value,
The abnormality determination unit calculates the time rate of change of the rotation angle of the rotating machine as the arithmetic processing for the verification, and the sign of the time rate of change of the rotation angle of the rotation angle is reversed. The controller for a rotating machine according to any one of claims 2 to 5, wherein a value obtained by subjecting the input torque value of the specific arithmetic processing to addition correction or subtraction correction is sometimes calculated as the verification torque value. .
前記異常判定部は、前記特定の演算処理の前記入力トルク値と前記出力トルク値との偏差に、前記特定の周波数帯の成分を減衰するバンドストップフィルタ処理を行った値に基づいて、前記特定の演算処理の動作異常を判定する請求項1に記載の回転機の制御装置。 The torque command value calculation unit performs, as the specific arithmetic processing, a band-pass filtering process for extracting a component of a specific frequency band with respect to the rotation speed of the rotating machine to extract the vibration component of the rotation speed, calculating a torque correction value for suppressing the vibration component of the rotation speed based on the vibration component of the rotation speed, and calculating a value obtained by subtracting the torque correction value from the input torque value as the output torque value;
The abnormality determination unit performs band-stop filter processing for attenuating components of the specific frequency band on the deviation between the input torque value and the output torque value of the specific arithmetic processing, and determines the specific torque based on the value. 2. The control device for a rotating machine according to claim 1, wherein the operation abnormality of the arithmetic processing of is determined.
前記異常判定部は、前記特定の演算処理の前記入力トルク値と前記出力トルク値との偏差に基づいて、前記特定の演算処理の動作異常を判定する請求項1又は7に記載の回転機の制御装置。 As the specific arithmetic processing, the torque command value calculation unit calculates a torque correction value for reducing torque ripple based on the rotation angle of the rotating machine, adds the torque correction value to the input torque value, and Calculate the output torque value,
8. The rotating machine according to claim 1, wherein the abnormality determination unit determines an operation abnormality of the specific arithmetic processing based on a deviation between the input torque value and the output torque value of the specific arithmetic processing. Control device.
前記異常判定部は、前記複数種類の前記特定の演算処理のいずれか1つ以上について、動作異常があると判定された場合に、前記トルク指令値算出部に動作異常が発生したと総合的に判定し、総合的な判定結果を出力する請求項1から8のいずれか一項に記載の回転機の制御装置。 The torque command value calculation unit performs the plurality of types of specific arithmetic processing connected in series in a process of calculating from the required torque to the torque command value,
The abnormality determination unit comprehensively determines that an operation abnormality has occurred in the torque command value calculation unit when it is determined that at least one of the plurality of types of specific arithmetic processing has an operation abnormality. 9. The control device for a rotating machine according to claim 1, which makes the determination and outputs a comprehensive determination result.
前記トルク指令値と前記出力トルクの推定値とに基づいて、前記回転機制御部の動作異常を判定し、
前記単数種類の前記特定の演算処理の動作異常の判定結果、又は前記複数種類の前記特定の演算処理のそれぞれの動作異常の判定結果、及び前記回転機制御部の動作異常の判定結果に基づいて、総合的な動作異常を判定し、総合的な判定結果を出力する請求項1から9のいずれか一項に記載の回転機の制御装置。 The abnormality determination unit acquires a control parameter of the rotating machine from the rotating machine control unit, estimates an output torque of the rotating machine based on the control parameter,
determining an operation abnormality of the rotating machine control unit based on the torque command value and the estimated value of the output torque;
Based on the determination result of the operation abnormality of the single type of the specific arithmetic processing, or the determination result of the operation abnormality of each of the plurality of types of the specific operation processing, and the determination result of the operation abnormality of the rotating machine control unit 10. The control device for a rotating machine according to any one of claims 1 to 9, which determines a comprehensive operation abnormality and outputs a comprehensive determination result.
前記回転機と、
前記回転機の駆動力を車両の車輪に伝達する駆動力伝達機構と、を備えた車両用駆動装置。 A control device for a rotating machine according to any one of claims 1 to 10;
the rotating machine;
and a driving force transmission mechanism for transmitting the driving force of the rotating machine to wheels of the vehicle.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021175140A JP7203176B1 (en) | 2021-10-27 | 2021-10-27 | Rotating machine control device and vehicle drive device |
CN202211294786.3A CN116032168A (en) | 2021-10-27 | 2022-10-21 | Control device for rotating electrical machine and vehicle drive device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021175140A JP7203176B1 (en) | 2021-10-27 | 2021-10-27 | Rotating machine control device and vehicle drive device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP7203176B1 true JP7203176B1 (en) | 2023-01-12 |
JP2023064795A JP2023064795A (en) | 2023-05-12 |
Family
ID=84887112
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021175140A Active JP7203176B1 (en) | 2021-10-27 | 2021-10-27 | Rotating machine control device and vehicle drive device |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP7203176B1 (en) |
CN (1) | CN116032168A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7485150B1 (en) | 2023-04-27 | 2024-05-16 | いすゞ自動車株式会社 | Control device for electric motor |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002067988A (en) | 2000-08-29 | 2002-03-08 | Denso Corp | Motor-driven power steering device |
JP2015142462A (en) | 2014-01-29 | 2015-08-03 | 日立アプライアンス株式会社 | Inverter control device and refrigerator employing the same |
-
2021
- 2021-10-27 JP JP2021175140A patent/JP7203176B1/en active Active
-
2022
- 2022-10-21 CN CN202211294786.3A patent/CN116032168A/en active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002067988A (en) | 2000-08-29 | 2002-03-08 | Denso Corp | Motor-driven power steering device |
JP2015142462A (en) | 2014-01-29 | 2015-08-03 | 日立アプライアンス株式会社 | Inverter control device and refrigerator employing the same |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7485150B1 (en) | 2023-04-27 | 2024-05-16 | いすゞ自動車株式会社 | Control device for electric motor |
Also Published As
Publication number | Publication date |
---|---|
CN116032168A (en) | 2023-04-28 |
JP2023064795A (en) | 2023-05-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10418929B2 (en) | Synchronous machine control device and permanent magnet temperature estimation method for synchronous machine | |
US9413281B2 (en) | Apparatus for controlling AC motor | |
JP2008295200A (en) | Synchronous motor control device and method for optimizing synchronous motor control | |
US20160375774A1 (en) | Permanent magnet-excited electric machine | |
JP5267848B2 (en) | Motor control device | |
CN109986968B (en) | Driving device | |
JP7203176B1 (en) | Rotating machine control device and vehicle drive device | |
US10483882B2 (en) | Drive device | |
JP5707761B2 (en) | Phase loss diagnosis apparatus and phase loss diagnosis method | |
JP2013085406A (en) | Control device for rotary machine and rotation angle calculation device | |
JP2003219698A (en) | Controller for synchronous machine | |
JP5923955B2 (en) | Control device for multi-phase rotating machine | |
JP2012257360A (en) | Controller of rotary machine | |
CN108432120B (en) | Control device for rotating electric machine | |
US11646686B2 (en) | Controller for AC rotary electric machine | |
DE112018008190T5 (en) | Rotary machine control device and electric vehicle control device | |
JP6693442B2 (en) | Motor drive | |
JP6696456B2 (en) | Motor drive | |
EP4207580A1 (en) | Rotating electric machine control device and electric power steering device | |
JP5605311B2 (en) | Rotating machine control device | |
US20240171100A1 (en) | Controller for rotary electric machine | |
EP4254776A1 (en) | Control device for rotating electric machine and electric power steering device | |
CN108575112B (en) | Apparatus and method for controlling motor | |
Inoue et al. | A novel method of maximum-power operation for IPMSMs in DTC system | |
JP2023183492A (en) | Control device for ac rotary machine and power generating electric motor device for vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20211027 |
|
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: 20221129 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20221226 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 7203176 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |