JP2012007334A - Motor torque control device of work machine - Google Patents

Motor torque control device of work machine Download PDF

Info

Publication number
JP2012007334A
JP2012007334A JP2010142743A JP2010142743A JP2012007334A JP 2012007334 A JP2012007334 A JP 2012007334A JP 2010142743 A JP2010142743 A JP 2010142743A JP 2010142743 A JP2010142743 A JP 2010142743A JP 2012007334 A JP2012007334 A JP 2012007334A
Authority
JP
Japan
Prior art keywords
speed
control gain
command
feedback signal
control
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
JP2010142743A
Other languages
Japanese (ja)
Other versions
JP5652857B2 (en
Inventor
Taizo Morita
大蔵 森田
Takashi Iguchi
高志 井口
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.)
Caterpillar SARL
Original Assignee
Caterpillar SARL
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 Caterpillar SARL filed Critical Caterpillar SARL
Priority to JP2010142743A priority Critical patent/JP5652857B2/en
Publication of JP2012007334A publication Critical patent/JP2012007334A/en
Application granted granted Critical
Publication of JP5652857B2 publication Critical patent/JP5652857B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

PROBLEM TO BE SOLVED: To improve control stability by decreasing control gain in a speed range affected by back lash of gear mechanism, and to prevent reduction of responsiveness using proper control gain in a speed range not affected by back lash of gear mechanism.SOLUTION: The motor torque control device 10 of the embodiment of the present invention is provided with control gain correction means 18 for correcting a control gain G1 used for the calculation of a torque instruction Trd. The control gain correction means 18 includes a speed threshold value ωd0 defining the upper limit of speed range affected by backlash of a speed reducer 8 occurs, and corrects and reduces the control gain G1 when a speed instruction ωd is less than the speed threshold value ωd0.

Description

本発明は、電動機(電動機及び発電機として機能する電動発電機を含む)のトルク制御にもとづいて作動体を作動させる油圧ショベル等の作業機械の電動機トルク制御装置に関する。   The present invention relates to a motor torque control device for a work machine such as a hydraulic excavator that operates an operating body based on torque control of an electric motor (including a motor and a motor generator functioning as a generator).

近年、油圧ショベル等の作業機械においても、省エネルギー化や排ガス低減等を達成するべく、動力源として電動機等の電気式動力装置を用いる電気式システムや、エンジンと電気式動力装置とを併用するハイブリッドシステムの採用が図られている。例えば、このような電気式システムやハイブリッドシステムを採用した作業機械の一つとして、下部走行体上に旋回自在に設けられる上部旋回体(作動体)を、電動機で旋回駆動させるようにしたものが知られている(例えば、特許文献1参照)。   In recent years, also in work machines such as hydraulic excavators, in order to achieve energy saving and exhaust gas reduction, an electric system using an electric power device such as an electric motor as a power source, or a hybrid using both an engine and an electric power device The system is being adopted. For example, as one of the working machines adopting such an electric system or a hybrid system, an upper swing body (actuating body) that is swingably provided on a lower traveling body is driven to rotate by an electric motor. It is known (see, for example, Patent Document 1).

このような作業機械には、電動機のトルク制御を行う電動機トルク制御装置が設けられている。従来の電動機トルク制御装置100は、例えば、図11に示すように、上部旋回体101を旋回操作する操作レバー102の操作位置にもとづいて速度指令ωdを演算する速度指令演算手段103と、上部旋回体101の速度フィードバック信号ωを読み込む速度フィードバック信号読込手段104と、速度指令ωdと速度フィードバック信号ωとの速度偏差Δωを演算する速度偏差演算手段105と、速度偏差Δωにもとづいて電動機106のトルク指令Trdを演算するトルク指令演算手段107とを備えて構成されている。   Such a working machine is provided with an electric motor torque control device that performs torque control of the electric motor. For example, as shown in FIG. 11, the conventional motor torque control apparatus 100 includes a speed command calculation means 103 that calculates a speed command ωd based on an operation position of an operation lever 102 that turns the upper swing body 101, and an upper swing. Speed feedback signal reading means 104 for reading the speed feedback signal ω of the body 101, speed deviation calculating means 105 for calculating the speed deviation Δω between the speed command ωd and the speed feedback signal ω, and the torque of the motor 106 based on the speed deviation Δω. Torque command calculation means 107 for calculating the command Trd is provided.

特開2005−273262号公報JP 2005-273262 A

図12に示すように、トルク指令Trdの演算には、速度偏差Δωに対するトルク指令Trdの比率を決める制御ゲインG1が用いられる。制御ゲインG1の最適値は、制御の安定性及び応答性を両立可能な値であり、一般的には、制御の安定性を確保し得るゲイン値の範囲内において、最大のゲイン値が用いられる。つまり、制御の安定性が高いシステムでは、制御ゲインG1の値を大きくして良好な応答性が得られるが、制御の安定性が低いシステムでは、応答性を犠牲にして制御ゲインG1の値を小さくする必要があった。   As shown in FIG. 12, the control gain G1 that determines the ratio of the torque command Trd to the speed deviation Δω is used for the calculation of the torque command Trd. The optimum value of the control gain G1 is a value that can achieve both control stability and responsiveness. In general, the maximum gain value is used within a range of gain values that can ensure control stability. . That is, in a system with high control stability, the control gain G1 can be increased to obtain a good response. However, in a system with low control stability, the control gain G1 can be set at the expense of response. It was necessary to make it smaller.

特に、ギヤ機構(例えば、ギヤ式の減速機108)を介して作動体を電動機に連繋させる作業機械では、ギヤ機構に存在するバックラッシュが制御の不安定要素になり、制御ゲインを大きくできないという問題があった。つまり、ギヤ機構のバックラッシュは、電動機の微小指令応答を大きくし、ハンチングなどの不安定事象を引き起す可能性がある。これを防止して制御の安定性を増すには、制御ゲインの値を小さくする必要があるので、大きなトルクが必要な負荷状況であっても、十分なトルクを発生させることができず、応答性が低下するという問題があった。   In particular, in a work machine in which an operating body is linked to an electric motor via a gear mechanism (for example, a gear-type speed reducer 108), backlash existing in the gear mechanism becomes an unstable element of control, and the control gain cannot be increased. There was a problem. That is, the backlash of the gear mechanism increases the minute command response of the electric motor and may cause unstable events such as hunting. In order to prevent this and increase the stability of the control, it is necessary to reduce the value of the control gain, so even in a load situation where a large torque is required, a sufficient torque cannot be generated, and the response There was a problem that the performance decreased.

尚、特許文献1では、起動時(旋回体検出速度が設定値以下)や押し付け時(旋回体速度指令と旋回体検出速度の偏差が設定値以上)に制御ゲインを所定値以下にすることが示されているが、ギヤ機構に存在するバックラッシュとの関係や、負荷が大きいときの応答性の向上については、何ら言及されていない。また、特許文献1では、旋回体検出速度を制御ゲインの補正条件としているので、ギヤ機構のバックラッシュに起因する電動機の速度変動を把握して制御に反映することは困難である。しかも、特許文献1では、旋回体速度指令と旋回体検出速度の偏差が設定値以上のとき、制御ゲインを所定値以下にするので、オペレータが高応答を期待する状況において制御ゲインが減少し、逆効果となる可能性がある。   In Patent Document 1, the control gain is set to a predetermined value or less at the time of start-up (the turning body detection speed is equal to or less than the set value) or when pressed (the deviation between the turning body speed command and the turning body detection speed is equal to or more than the set value). Although shown, there is no mention of the relationship with the backlash existing in the gear mechanism and the improvement in response when the load is large. Further, in Patent Document 1, since the turning body detection speed is used as a control gain correction condition, it is difficult to grasp the fluctuation in the speed of the motor caused by the backlash of the gear mechanism and reflect it in the control. Moreover, in Patent Document 1, when the deviation between the swing body speed command and the swing body detection speed is equal to or greater than a set value, the control gain is set to a predetermined value or less, so that the control gain decreases in a situation where the operator expects a high response, It can be counterproductive.

本発明は、上記の如き実情に鑑みこれらの課題を解決することを目的として創作されたものであって、ギヤ機構を介して作動体を電動機に連繋し、該電動機のトルク制御にもとづいて前記作動体を作動させる作業機械の電動機トルク制御装置であって、該電動機トルク制御装置は、前記作動体を操作する操作具の操作位置にもとづいて速度指令を演算する速度指令演算手段と、前記電動機及び/又は前記作動体の速度フィードバック信号を読み込む速度フィードバック信号読込手段と、前記速度指令と前記速度フィードバック信号との速度偏差を演算する速度偏差演算手段と、前記速度偏差にもとづいて前記電動機のトルク指令を演算するトルク指令演算手段と、前記トルク指令の演算に用いる制御ゲインを補正する制御ゲイン補正手段とを備え、該制御ゲイン補正手段は、前記ギヤ機構のバックラッシュが影響する速度域の上限を定める速度閾値を備えると共に、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値以下のとき、前記制御ゲインを減少側に補正することを特徴とする。
また、前記制御ゲイン補正手段は、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値を超えているとき、前記制御ゲインを増加側に補正することを特徴とする。
また、前記制御ゲイン補正手段は、前記制御ゲインに乗算される補正値を、前記速度指令又は前記電動機の速度フィードバック信号に応じて変化させる補正演算パターンを有し、該補正演算パターンにおける補正値の最大値及び最小値を定めると共に、前記速度閾値よりも大きい第二の速度閾値を備え、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値以下のときは、前記最小値を用いて前記制御ゲインを減少側に補正し、前記速度指令又は前記電動機の速度フィードバック信号が前記第二の速度閾値を超えているときは、前記最大値を用いて前記制御ゲインを増加側に補正し、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値を超え、かつ、前記第二の速度閾値以下のときは、前記速度指令又は前記電動機の速度フィードバック信号に比例する補正値を用いて前記制御ゲインを減少側又は増加側に補正することを特徴とする。
また、前記制御ゲイン補正手段は、前記速度指令と前記速度フィードバック信号の比較にもとづいて加速時であるか減速時であるかを判断すると共に、加速時と減速時では異なる補正演算パターンを用いて前記制御ゲインを補正することを特徴とする。
The present invention has been created in order to solve these problems in view of the above circumstances, and an operating body is connected to an electric motor through a gear mechanism, and the above-described operation is performed based on torque control of the electric motor. An electric motor torque control device for a work machine that operates an operating body, wherein the electric motor torque control device calculates a speed command based on an operation position of an operating tool that operates the operating body, and the electric motor And / or speed feedback signal reading means for reading the speed feedback signal of the operating body, speed deviation calculating means for calculating a speed deviation between the speed command and the speed feedback signal, and torque of the electric motor based on the speed deviation A torque command calculating means for calculating a command, and a control gain correcting means for correcting a control gain used for calculating the torque command. The control gain correction means includes a speed threshold value that determines an upper limit of a speed range in which the backlash of the gear mechanism affects, and when the speed command or the speed feedback signal of the motor is equal to or lower than the speed threshold value, The gain is corrected to the decreasing side.
The control gain correction means corrects the control gain to an increase side when the speed command or the speed feedback signal of the electric motor exceeds the speed threshold value.
The control gain correction means has a correction calculation pattern for changing a correction value multiplied by the control gain in accordance with the speed command or a speed feedback signal of the electric motor, and the correction value in the correction calculation pattern A maximum speed and a minimum value are determined, and a second speed threshold value greater than the speed threshold value is provided, and when the speed command or the speed feedback signal of the motor is equal to or less than the speed threshold value, the control is performed using the minimum value When the gain is corrected to the decrease side and the speed command or the speed feedback signal of the electric motor exceeds the second speed threshold, the control gain is corrected to the increase side using the maximum value, and the speed When the command or the speed feedback signal of the motor exceeds the speed threshold and is equal to or less than the second speed threshold, the speed command or Using the correction value proportional to the speed feedback signal of the serial motor and correcting the reduction side or the increase side the control gain.
The control gain correction means determines whether the vehicle is accelerating or decelerating based on a comparison between the speed command and the speed feedback signal, and uses different correction calculation patterns for acceleration and deceleration. The control gain is corrected.

請求項1の発明によれば、ギヤ機構のバックラッシュが影響する速度域の上限を定める速度閾値を備えると共に、速度指令又は電動機の速度フィードバック信号が速度閾値以下のとき、制御ゲインを減少側に補正するので、ギヤ機構のバックラッシュが影響する速度域においては、制御ゲインを小さくして制御の安定性を向上させることができる一方、ギヤ機構のバックラッシュが影響しない速度域においては、適正な制御ゲインを用いることにより応答性の低下を防止することができる。特に、速度指令に応じて制御ゲインを補正する場合は、オペレータが高応答を期待する状況(速度指令大)において、制御ゲインが減少側に補正されるというオペレータの意思に反した制御動作を確実に防止することができる。また、電動機の速度フィードバック信号に応じて制御ゲインを補正する場合は、作動体の速度フィードバック信号を用いる場合に比べ、ギヤ機構のバックラッシュに起因する速度変動を明確に把握して制御に反映することができる。
また、請求項2の発明によれば、速度指令又は電動機の速度フィードバック信号が速度閾値を超えているとき、制御ゲインを増加側に補正するので、ギヤ機構のバックラッシュが影響しない速度域において、可及的に大きな制御ゲインを適用し、負荷が大きい状況でも良好な応答性を示すことができる。
また、請求項3の発明によれば、制御ゲインを減少側に補正する速度域と、制御ゲインを増加側に補正する速度域との間において、制御ゲインが急激に変化することを防止できるので、制御ゲインの急激な変化に伴う速度変動や衝撃の発生を回避することができる。
また、請求項4の発明によれば、速度指令と速度フィードバック信号の比較にもとづいて加速時であるか減速時であるかを判断すると共に、加速時と減速時では異なる補正演算パターンを用いて制御ゲインを補正するので、加速時と減速時の特性の違いが反映された制御ゲインの補正を行うことができる。
According to the first aspect of the present invention, a speed threshold value that determines an upper limit of the speed range in which the backlash of the gear mechanism affects is provided, and when the speed command or the speed feedback signal of the motor is equal to or lower than the speed threshold value, the control gain is decreased. Since the correction is made, the control gain can be reduced to improve the control stability in the speed range where the gear mechanism backlash is affected, while in the speed range where the gear mechanism is not affected by the backlash, By using the control gain, it is possible to prevent a decrease in responsiveness. In particular, when the control gain is corrected according to the speed command, in a situation where the operator expects a high response (the speed command is large), the control operation against the operator's intention is surely corrected. Can be prevented. Also, when the control gain is corrected according to the speed feedback signal of the electric motor, the speed fluctuation caused by the backlash of the gear mechanism is clearly grasped and reflected in the control, compared with the case where the speed feedback signal of the operating body is used. be able to.
According to the invention of claim 2, when the speed command or the speed feedback signal of the motor exceeds the speed threshold value, the control gain is corrected to the increase side. Therefore, in the speed range where the backlash of the gear mechanism does not affect, By applying a control gain as large as possible, it is possible to show a good response even under a heavy load condition.
According to the invention of claim 3, since the control gain can be prevented from changing suddenly between the speed range in which the control gain is corrected to the decreasing side and the speed range in which the control gain is corrected to the increasing side. Thus, it is possible to avoid the occurrence of speed fluctuations and impacts due to a sudden change in control gain.
According to the invention of claim 4, it is determined whether the vehicle is accelerating or decelerating based on the comparison between the speed command and the speed feedback signal, and different correction calculation patterns are used for acceleration and deceleration. Since the control gain is corrected, the control gain can be corrected to reflect the difference in characteristics between acceleration and deceleration.

油圧ショベルの側面図である。It is a side view of a hydraulic excavator. 電気式旋回システムの制御構成を示す制御ブロック図である。It is a control block diagram which shows the control structure of an electric turning system. 電動機トルク制御に用いる制御ゲインの補正演算パターンを示す説明図である。It is explanatory drawing which shows the correction calculation pattern of the control gain used for motor torque control. 電動機トルク制御の処理手順を示すフローチャート図である。It is a flowchart figure which shows the process sequence of electric motor torque control. 制御ゲイン補正演算(パターンA)の処理手順を示すフローチャート図である。It is a flowchart figure which shows the process sequence of control gain correction | amendment calculation (pattern A). 制御ゲイン補正演算(パターンB)の処理手順を示すフローチャート図である。It is a flowchart figure which shows the process sequence of a control gain correction | amendment calculation (pattern B). 制御ゲイン補正演算(パターンC)の処理手順を示すフローチャート図である。It is a flowchart figure which shows the process sequence of control gain correction | amendment calculation (pattern C). 第二実施形態に係る制御ブロック図である。It is a control block diagram concerning a second embodiment. 第三実施形態に係る制御ブロック図である。It is a control block diagram concerning a third embodiment. 第三実施形態に係る制御ゲインの補正演算パターンを示す説明図である。It is explanatory drawing which shows the correction calculation pattern of the control gain which concerns on 3rd embodiment. 従来例に係る制御ブロック図である。It is a control block diagram concerning a conventional example. (A)は、速度指令演算の例を示す説明図、(B)は、トルク指令演算の例を示す説明図である。(A) is explanatory drawing which shows the example of speed command calculation, (B) is explanatory drawing which shows the example of torque command calculation.

以下、本発明の実施の形態について、図面に基づいて説明する。図1は、作業機械の一例である油圧ショベルであって、該油圧ショベル1は、クローラ式の下部走行体2、該下部走行体2に旋回自在に支持される上部旋回体3、該上部旋回体3に装着される作業部4等から構成され、さらに、該作業部4は、ブーム5、アーム6、バケット7等を用いて構成されている。   Hereinafter, embodiments of the present invention will be described with reference to the drawings. FIG. 1 shows a hydraulic excavator that is an example of a work machine. The hydraulic excavator 1 includes a crawler-type lower traveling body 2, an upper revolving body 3 that is rotatably supported by the lower traveling body 2, and the upper revolving body. The working unit 4 is mounted on the body 3, and the working unit 4 is configured by using a boom 5, an arm 6, a bucket 7, and the like.

図2は、油圧ショベル1に適用される電気式旋回システムの制御構成を示す制御ブロック図であって、油圧ショベル1では、ギヤ式の減速機(ギヤ機構)8を介して上部旋回体3を電動機9に連繋し、該電動機9のトルク制御にもとづいて上部旋回体3を旋回作動させるように構成されている。尚、電動機9としては、電動機及び発電機として機能する電動発電機を用いてもよい。   FIG. 2 is a control block diagram showing a control configuration of an electric swing system applied to the hydraulic excavator 1. In the hydraulic excavator 1, the upper swing body 3 is connected via a gear type reduction gear (gear mechanism) 8. The upper swing body 3 is connected to the electric motor 9 and is operated to rotate based on torque control of the electric motor 9. In addition, as the electric motor 9, you may use the motor generator which functions as an electric motor and a generator.

油圧ショベル1には、電動機9のトルク制御を行う電動機トルク制御装置10が設けられている。本実施形態の電動機トルク制御装置10は、操作レバー(操作具)11の操作位置を検出する操作位置検出手段12、電動機9の速度ωaを検出する電動機速度検出手段13a、上部旋回体3の速度ωbを検出する旋回体速度検出手段13bなどから検出信号を入力すると共に、これらの入力信号に応じて電動機9の駆動トルクを制御するが、制御対象が電動発電機である場合は、駆動トルクだけでなく、回生トルクの制御も行うことができる。   The hydraulic excavator 1 is provided with an electric motor torque control device 10 that performs torque control of the electric motor 9. The motor torque control device 10 according to the present embodiment includes an operation position detection unit 12 that detects an operation position of an operation lever (operation tool) 11, a motor speed detection unit 13 a that detects a speed ωa of the motor 9, and a speed of the upper swing body 3. A detection signal is input from the revolving body speed detection means 13b or the like that detects ωb, and the drive torque of the motor 9 is controlled according to these input signals. If the control target is a motor generator, only the drive torque is controlled. In addition, the regenerative torque can be controlled.

電動機トルク制御装置10は、操作レバー11の操作位置にもとづいて速度指令ωdを演算する速度指令演算手段14と、電動機9及び/又は上部旋回体3の速度フィードバック信号ωを読み込む速度フィードバック信号読込手段15と、速度指令ωdと速度フィードバック信号ωとの速度偏差Δωを演算する速度偏差演算手段16と、速度偏差Δωにもとづいて電動機9のトルク指令Trdを演算するトルク指令演算手段17とを備えている。   The motor torque control device 10 includes a speed command calculating unit 14 that calculates a speed command ωd based on the operation position of the operation lever 11, and a speed feedback signal reading unit that reads the speed feedback signal ω of the motor 9 and / or the upper swing body 3. 15, a speed deviation calculating means 16 for calculating a speed deviation Δω between the speed command ωd and the speed feedback signal ω, and a torque command calculating means 17 for calculating a torque command Trd of the electric motor 9 based on the speed deviation Δω. Yes.

トルク指令Trdの演算には、速度偏差Δωに対するトルク指令Trdの比率を決める制御ゲインG1が用いられる。例えば、P制御(比例制御)の場合は、比例要素である制御ゲインG1が伝達関数として使用され、PI制御(比例積分制御)の場合は、比例要素である制御ゲインG1と、積分要素(T1/s)との加算値が伝達関数として使用される。尚、T1は時定数パラメータであり、sはラプラス演算子である。   For calculation of the torque command Trd, a control gain G1 that determines the ratio of the torque command Trd to the speed deviation Δω is used. For example, in the case of P control (proportional control), a control gain G1 that is a proportional element is used as a transfer function, and in the case of PI control (proportional integral control), a control gain G1 that is a proportional element and an integral element (T1) / S) is used as the transfer function. T1 is a time constant parameter, and s is a Laplace operator.

制御ゲインG1の最適値は、制御の安定性及び応答性を両立可能な値であり、一般的には、制御の安定性を確保し得る制御ゲインの範囲内において、最大の値が用いられる。しかしながら、ギヤ式の減速機8を介して上部旋回体3を旋回させる油圧ショベル1では、減速機8に存在するバックラッシュが制御の不安定要素になるので、応答性を犠牲にして制御ゲインG1を小さくする必要があった。   The optimum value of the control gain G1 is a value that can achieve both control stability and responsiveness. In general, the maximum value is used within the range of the control gain that can ensure control stability. However, in the hydraulic excavator 1 that turns the upper swing body 3 via the gear type speed reducer 8, the backlash existing in the speed reducer 8 becomes an unstable element of control, and therefore, the control gain G1 is sacrificed at the sacrifice of responsiveness. It was necessary to make it smaller.

例えば、減速機8の機器ゲイン(指令速度に対する出力速度の比率)をG2とした場合、バックラッシュによってギヤが噛み合っていない状態では、機器ゲインG2が大きく、ギヤが噛み合っている状態では、機器ゲインG2が小さくなる。このような機器ゲインG2の変動は、電動機9の微小指令応答を大きくし、ハンチングなどの不安定事象を引き起す可能性があるので、従来では、制御の安定性を確保するために制御ゲインG1の値を小さくしていた。その結果、大きなトルクが必要な負荷状況(負荷=1/M1s+c)であっても、十分なトルクを発生させることができず、応答性が低下するという問題が生じていた。尚、M1は純粋な負荷と装置の慣性力との加算値であり、cは装置の抵抗係数である。   For example, when the device gain of the reducer 8 (the ratio of the output speed to the command speed) is G2, the device gain G2 is large when the gear is not engaged due to backlash, and the device gain is obtained when the gear is engaged. G2 becomes smaller. Such fluctuation of the device gain G2 increases the minute command response of the electric motor 9 and may cause an unstable event such as hunting. Therefore, conventionally, in order to ensure the stability of the control, the control gain G1 The value of was reduced. As a result, even in a load situation where a large torque is required (load = 1 / M1s + c), a sufficient torque cannot be generated, resulting in a problem that the responsiveness is lowered. M1 is a sum of a pure load and the inertial force of the device, and c is a resistance coefficient of the device.

上記のような問題は、制御ゲインG1を運転状態に応じて可変とすることにより解決可能と考えられる。例えば、システム全体のゲインをG0、T1≒0とすると、システムゲインG0は、下記の式で表すことができる。
G0=G1×G2/(M1s+c)
ここで、G0が最適なシステムゲインとすると、最適な制御ゲインG1は、下記の式で表すことができる。
G1=G0/G2×(M1s+c)
そして、機器ゲインG2と負荷M1は、運転状況に応じて変化する変数であるため、機器ゲインG2と負荷M1を把握することにより、制御ゲインG1を最適値に調整(補正)することが可能になる。具体的には、負荷が小さく、かつ、バックラッシュが影響する運転状況では、制御ゲインG1を減少側に補正し、負荷が大きい運転状況では、制御ゲインG1を増加側に補正することにより、制御の安定性及び応答性を両立可能な最適な制御ゲインG1を得る。
以下、制御ゲインG1の補正処理について詳細に説明する。
The above problems can be solved by making the control gain G1 variable according to the operating state. For example, when the gain of the entire system is G0 and T1≈0, the system gain G0 can be expressed by the following equation.
G0 = G1 × G2 / (M1s + c)
Here, when G0 is the optimum system gain, the optimum control gain G1 can be expressed by the following equation.
G1 = G0 / G2 × (M1s + c)
Since the device gain G2 and the load M1 are variables that change according to the driving situation, the control gain G1 can be adjusted (corrected) to an optimum value by grasping the device gain G2 and the load M1. Become. Specifically, the control gain G1 is corrected to the decreasing side in an operating situation where the load is small and backlash is affected, and the control gain G1 is corrected to the increasing side in an operating condition where the load is large. An optimum control gain G1 that can achieve both stability and responsiveness is obtained.
Hereinafter, the correction process of the control gain G1 will be described in detail.

図2に示すように、電動機トルク制御装置10は、制御ゲインG1を補正する制御ゲイン補正手段18を備えている。制御ゲイン補正手段18は、減速機8のバックラッシュが影響する速度域の上限を定める速度閾値ωd0を備えると共に、速度指令ωdが速度閾値ωd0以下のとき、制御ゲインG1を減少側に補正するようになっている。このようにすると、減速機8のバックラッシュが影響する速度域においては、制御ゲインG1を小さくして制御の安定性を向上させることができる一方、減速機8のバックラッシュが影響しない速度域においては、適正な制御ゲインG1を用いることにより応答性の低下を防止することができる。特に、本実施形態では、速度指令ωdに応じて制御ゲインG1を補正するので、オペレータが高応答を期待する状況(速度指令ωd大)において、制御ゲインG1が減少側に補正されるというオペレータの意思に反した制御動作を確実に防止することができる。   As shown in FIG. 2, the motor torque control device 10 includes control gain correction means 18 that corrects the control gain G1. The control gain correction means 18 includes a speed threshold ωd0 that defines an upper limit of the speed range in which the backlash of the speed reducer 8 affects, and when the speed command ωd is equal to or less than the speed threshold ωd0, the control gain G1 is corrected to the decreasing side. It has become. In this way, in the speed range where the backlash of the speed reducer 8 is affected, the control gain G1 can be reduced to improve the control stability, while in the speed range where the backlash of the speed reducer 8 is not affected. Can prevent a decrease in responsiveness by using an appropriate control gain G1. In particular, in the present embodiment, the control gain G1 is corrected in accordance with the speed command ωd. Therefore, in a situation where the operator expects a high response (the speed command ωd is large), the operator is urged to correct the control gain G1 to the decreasing side. It is possible to reliably prevent a control action against the intention.

また、制御ゲイン補正手段18は、速度指令ωdが速度閾値ωd0を超えているとき、制御ゲインG1を増加側に補正するようになっている。このようにすると、減速機8のバックラッシュが影響しない速度域において、可及的に大きな制御ゲインを適用し、負荷が大きい状況でも良好な応答性を示すことができる。特に、本実施形態では、速度指令ωdに応じて制御ゲインG1を補正するので、オペレータが高応答を期待する状況において制御ゲインG1を確実に増加させることができる。   The control gain correction means 18 corrects the control gain G1 to the increase side when the speed command ωd exceeds the speed threshold value ωd0. In this way, it is possible to apply as large a control gain as possible in a speed range where the backlash of the speed reducer 8 does not affect, and to exhibit good responsiveness even under a heavy load condition. In particular, in the present embodiment, the control gain G1 is corrected according to the speed command ωd, so that the control gain G1 can be reliably increased in a situation where the operator expects a high response.

また、制御ゲイン補正手段18は、図3に示すように、制御ゲインG1に乗算される補正値hを、速度指令ωdに応じて変化させる補正演算パターン(パターンA〜C)を有する。これらの補正演算パターンのうち、パターンB、Cでは、補正演算パターンにおける補正値hの最大値hmax及び最小値hminを定めると共に、速度閾値ωd0よりも大きい第二の速度閾値ωd1を備え、速度指令ωdが速度閾値ωd0以下のときは、最小値hminを用いて制御ゲインG1を減少側に補正し、速度指令ωdが第二の速度閾値ωd1を超えているときは、最大値hmaxを用いて制御ゲインG1を増加側に補正し、速度指令ωdが速度閾値ωd0を超え、かつ、第二の速度閾値ωd1以下のときは、速度指令ωdに比例する後述の補正値を用いて制御ゲインG1を減少側又は増加側に補正するように設定されている。このようにすると、制御ゲインG1を減少側に補正する速度域と、制御ゲインG1を増加側に補正する速度域との間において、制御ゲインG1が急激に変化することを防止できるので、制御ゲインG1の急激な変化に伴う速度変動や衝撃の発生を回避することができる。   Further, as shown in FIG. 3, the control gain correction means 18 has a correction calculation pattern (patterns A to C) for changing the correction value h multiplied by the control gain G1 in accordance with the speed command ωd. Among these correction calculation patterns, patterns B and C define a maximum value hmax and a minimum value hmin of the correction value h in the correction calculation pattern, and have a second speed threshold value ωd1 larger than the speed threshold value ωd0. When ωd is equal to or less than the speed threshold value ωd0, the control gain G1 is corrected to the decreasing side using the minimum value hmin, and when the speed command ωd exceeds the second speed threshold value ωd1, control is performed using the maximum value hmax. The gain G1 is corrected to increase, and when the speed command ωd exceeds the speed threshold value ωd0 and is equal to or less than the second speed threshold value ωd1, the control gain G1 is decreased using a correction value that will be described later in proportion to the speed command ωd. It is set to correct to the side or the increase side. In this way, it is possible to prevent the control gain G1 from changing suddenly between the speed range in which the control gain G1 is corrected to the decreasing side and the speed range in which the control gain G1 is corrected to the increasing side. It is possible to avoid the occurrence of speed fluctuations and impacts accompanying a sudden change in G1.

また、制御ゲイン補正手段18は、速度指令ωdと速度フィードバック信号ωの比較にもとづいて加速時であるか減速時であるかを判断すると共に、加速時と減速時では異なる補正演算パターンを用いて制御ゲインG1を補正することができる。このようにすると、加速時と減速時の特性の違いが反映された制御ゲインG1の補正を行うことができる。   The control gain correction means 18 determines whether the vehicle is accelerating or decelerating based on the comparison between the speed command ωd and the speed feedback signal ω, and uses different correction calculation patterns during acceleration and deceleration. The control gain G1 can be corrected. In this way, it is possible to correct the control gain G1 reflecting the difference in characteristics between acceleration and deceleration.

次に、電動機トルク制御装置10における電動機トルク制御の具体的な制御手順について、図4〜図7を参照して説明する。但し、制御ゲインG1、時定数パラメータT1、停止用時定数パラメータT1stop、停止用補正値hstop、速度閾値ωd0、ωd1などは、予め与えられているものとする。   Next, a specific control procedure of the motor torque control in the motor torque control device 10 will be described with reference to FIGS. However, the control gain G1, the time constant parameter T1, the stop time constant parameter T1stop, the stop correction value hstop, the speed threshold values ωd0, ωd1, and the like are given in advance.

図4に示すように、電動機トルク制御では、操作レバー11の操作位置にもとづいて速度指令ωdを演算すると共に(S1)、電動機9及び/又は上部旋回体3の速度フィードバック信号ωを読み込み(S2)、速度指令ωdと速度フィードバック信号ωとの速度偏差Δωを演算する(S3)。   As shown in FIG. 4, in the motor torque control, the speed command ωd is calculated based on the operation position of the operation lever 11 (S1), and the speed feedback signal ω of the motor 9 and / or the upper swing body 3 is read (S2). ), A speed deviation Δω between the speed command ωd and the speed feedback signal ω is calculated (S3).

次に、速度指令ωdと速度フィードバック信号ωの比較にもとづいて加速時であるか減速時であるかを判断する(S4)。そして、加速時であると判断した場合は、加速用の補正値演算パターン(図3参照)を用いて補正値hを演算し(S5:図5〜図7参照)、減速時であると判断した場合は、加速用とは異なる減速用の補正値演算パターン(図示せず)を用いて補正値hを演算する(S6)。   Next, it is determined whether the vehicle is accelerating or decelerating based on a comparison between the speed command ωd and the speed feedback signal ω (S4). When it is determined that the vehicle is accelerating, the correction value h is calculated using the acceleration correction value calculation pattern (see FIG. 3) (S5: see FIGS. 5 to 7), and it is determined that the vehicle is decelerating. In this case, the correction value h is calculated using a correction value calculation pattern (not shown) for deceleration different from that for acceleration (S6).

次に、上部旋回体3が旋回停止状態であるか否かを判断する(S7)。例えば、速度指令ωd=0、かつ、速度フィードバック信号ω=0の状態が所定時間継続したとき、旋回停止状態であると判断する。そして、旋回停止状態であると判断した場合は、停止位置保持に必要なトルク指令Trdを出力するべく、補正値hに停止用補正値hstopをセットすると共に、時定数パラメータT1に停止用時定数パラメータT1stopをセットする(S8)。   Next, it is determined whether or not the upper swing body 3 is in a turning stop state (S7). For example, when the state of the speed command ωd = 0 and the speed feedback signal ω = 0 continues for a predetermined time, it is determined that the turning is stopped. If it is determined that the vehicle is in the turning stop state, the stop correction value hstop is set as the correction value h to output the torque command Trd necessary for holding the stop position, and the stop time constant is set in the time constant parameter T1. The parameter T1stop is set (S8).

次に、制御ゲインG1と補正値hを乗算して補正制御ゲインG1を求めると共に(S9)、トルク指令Trdを下記の式を用いて演算し(S10)、トルク指令Trdにもとづいたトルク出力Trを行う(S11)。
トルク指令Trd=Δω×(G1×h+T1/s)
Next, the control gain G1 is multiplied by the correction value h to obtain the correction control gain G1 (S9), and the torque command Trd is calculated using the following formula (S10), and the torque output Tr based on the torque command Trd is calculated. (S11).
Torque command Trd = Δω × (G1 × h + T1 / s)

図5は、制御ゲイン補正演算(パターンA)の処理手順を示すフローチャート図であって、パターンAを用いて補正値hを演算する場合は、まず、速度指令ωdが速度閾値ωd0以下であるか否かを判断する(S21)。そして、この判断結果がYESの場合は、補正値hに最小値hminをセットし(S22)、判断結果がNOの場合は、補正値hに1をセットする(S23)。   FIG. 5 is a flowchart showing the processing procedure of the control gain correction calculation (pattern A). When calculating the correction value h using the pattern A, first, is the speed command ωd equal to or less than the speed threshold ωd0? It is determined whether or not (S21). If the determination result is YES, the minimum value hmin is set to the correction value h (S22), and if the determination result is NO, 1 is set to the correction value h (S23).

図6は、制御ゲイン補正演算(パターンB)の処理手順を示すフローチャート図であって、パターンBを用いて補正値hを演算する場合は、まず、速度指令ωdが速度閾値ωd0以下であるか否かを判断する(S31)。そして、この判断結果がYESの場合は、補正値hに最小値hminをセットする(S32)。一方、ステップS31の判断結果がNOの場合は、速度指令ωdが第二の速度閾値ωd1を超えているか否かを判断する(S33)。そして、この判断結果がYESの場合は、補正値hに最大値hmaxをセットするが(S34)、判断結果がNOの場合は、下記の式を用いて速度指令ωdに比例する補正値を演算して補正値hにセットする(S35)。
補正値h=hmin+{(hmax−hmin)/(ωd1−ωd0)}×(ωd−ωd0)
FIG. 6 is a flowchart showing the processing procedure of the control gain correction calculation (pattern B). When calculating the correction value h using the pattern B, first, is the speed command ωd equal to or less than the speed threshold ωd0? It is determined whether or not (S31). If the determination result is YES, the minimum value hmin is set as the correction value h (S32). On the other hand, if the determination result in step S31 is NO, it is determined whether or not the speed command ωd exceeds the second speed threshold value ωd1 (S33). If the determination result is YES, the maximum value hmax is set to the correction value h (S34). If the determination result is NO, a correction value proportional to the speed command ωd is calculated using the following equation. Then, the correction value h is set (S35).
Correction value h = hmin + {(hmax−hmin) / (ωd1−ωd0)} × (ωd−ωd0)

図7は、制御ゲイン補正演算(パターンC)の処理手順を示すフローチャート図であって、パターンCを用いて補正値hを演算する場合は、まず、速度指令ωdが速度閾値ωd0以下であるか否かを判断する(S41)。そして、この判断結果がYESの場合は、補正値hに最小値hminをセットする(S42)。一方、ステップS41の判断結果がNOの場合は、速度指令ωdが第二の速度閾値ωd1を超えているか否かを判断する(S43)。そして、この判断結果がYESの場合は、補正値hに最大値hmaxをセットするが(S44)、判断結果がNOの場合は、下記の式を用いて速度指令ωdに比例する補正値を演算して補正値hにセットする(S45)。
補正値h=1+{(hmax−hmin)/(ωd1−ωd0)}×(ωd−ωd0)
FIG. 7 is a flowchart showing the processing procedure of the control gain correction calculation (pattern C). When calculating the correction value h using the pattern C, first, is the speed command ωd equal to or less than the speed threshold ωd0? It is determined whether or not (S41). If the determination result is YES, the minimum value hmin is set as the correction value h (S42). On the other hand, when the determination result of step S41 is NO, it is determined whether or not the speed command ωd exceeds the second speed threshold value ωd1 (S43). If the determination result is YES, the maximum value hmax is set to the correction value h (S44). If the determination result is NO, a correction value proportional to the speed command ωd is calculated using the following equation. Then, the correction value h is set (S45).
Correction value h = 1 + {(hmax−hmin) / (ωd1−ωd0)} × (ωd−ωd0)

叙述の如く構成された本実施形態によれば、減速機8を介して上部旋回体3を電動機9に連繋し、該電動機9のトルク制御にもとづいて上部旋回体3を旋回作動させる油圧ショベル1の電動機トルク制御装置10であって、該電動機トルク制御装置10は、上部旋回体3を旋回操作する操作レバー11の操作位置にもとづいて速度指令ωdを演算する速度指令演算手段14と、電動機9及び/又は上部旋回体3の速度フィードバック信号ωを読み込む速度フィードバック信号読込手段15と、速度指令ωdと速度フィードバック信号ωとの速度偏差Δωを演算する速度偏差演算手段16と、速度偏差Δωにもとづいて電動機9のトルク指令Trdを演算するトルク指令演算手段17と、トルク指令Trdの演算に用いる制御ゲインG1を補正する制御ゲイン補正手段18とを備え、該制御ゲイン補正手段18は、減速機8のバックラッシュが影響する速度域の上限を定める速度閾値ωd0を備えると共に、速度指令ωdが速度閾値ωd0以下のとき、制御ゲインG1を減少側に補正するので、減速機8のバックラッシュが影響する速度域においては、制御ゲインG1を小さくして制御の安定性を向上させることができる一方、減速機8のバックラッシュが影響しない速度域においては、適正な制御ゲインG1を用いることにより応答性の低下を防止することができる。特に、本実施形態では、速度指令ωdに応じて制御ゲインG1を補正するので、オペレータが高応答を期待する状況(速度指令ωd大)において、制御ゲインG1が減少側に補正されるというオペレータの意思に反した制御動作を確実に防止することができる。   According to the present embodiment configured as described above, the upper swing body 3 is connected to the electric motor 9 via the speed reducer 8, and the upper excavator 3 is turned based on the torque control of the electric motor 9. The motor torque control device 10 includes a speed command calculating means 14 for calculating a speed command ωd based on an operation position of an operation lever 11 for turning the upper swing body 3, and an electric motor 9. And / or speed feedback signal reading means 15 for reading the speed feedback signal ω of the upper-part turning body 3, speed deviation calculating means 16 for calculating the speed deviation Δω between the speed command ωd and the speed feedback signal ω, and the speed deviation Δω. Torque command calculating means 17 for calculating the torque command Trd of the motor 9 and a control gain G1 used for calculating the torque command Trd. Control gain correction means 18, the control gain correction means 18 includes a speed threshold ωd0 that defines an upper limit of the speed range in which the backlash of the speed reducer 8 affects, and when the speed command ωd is equal to or less than the speed threshold ωd0, Since the control gain G1 is corrected to the decreasing side, the control gain G1 can be reduced to improve control stability in the speed range where the backlash of the speed reducer 8 affects, while the backlash of the speed reducer 8 is improved. In a speed range where no influence is exerted, it is possible to prevent a decrease in responsiveness by using an appropriate control gain G1. In particular, in the present embodiment, the control gain G1 is corrected in accordance with the speed command ωd. Therefore, in a situation where the operator expects a high response (the speed command ωd is large), the operator is urged to correct the control gain G1 to the decreasing side. It is possible to reliably prevent a control action against the intention.

また、制御ゲイン補正手段18は、速度指令ωdが速度閾値ωd0を超えているとき、制御ゲインG1を増加側に補正するので、減速機8のバックラッシュが影響しない速度域において、可及的に大きな制御ゲインを適用し、負荷が大きい状況でも良好な応答性を示すことができる。特に、本実施形態では、速度指令ωdに応じて制御ゲインG1を補正するので、オペレータが高応答を期待する状況において制御ゲインG1を確実に増加させることができる。   Further, when the speed command ωd exceeds the speed threshold value ωd0, the control gain correction means 18 corrects the control gain G1 to the increase side. Therefore, in the speed range where the backlash of the speed reducer 8 does not affect as much as possible. By applying a large control gain, it is possible to show a good response even under a heavy load condition. In particular, in the present embodiment, the control gain G1 is corrected according to the speed command ωd, so that the control gain G1 can be reliably increased in a situation where the operator expects a high response.

また、制御ゲイン補正手段18は、制御ゲインG1に乗算される補正値hを、速度指令ωdに応じて変化させる補正演算パターン(パターンB、C)を有し、該補正演算パターンにおける補正値hの最大値hmax及び最小値hminを定めると共に、速度閾値ωd0よりも大きい第二の速度閾値ωd1を備え、速度指令ωdが速度閾値ωd0以下のときは、最小値hminを用いて制御ゲインG1を減少側に補正し、速度指令ωdが第二の速度閾値ωd1を超えているときは、最大値hmaxを用いて制御ゲインG1を増加側に補正し、速度指令ωdが速度閾値ωd0を超え、かつ、第二の速度閾値ωd1以下のときは、速度指令ωdに比例する補正値を用いて制御ゲインG1を減少側又は増加側に補正するので、制御ゲインG1を減少側に補正する速度域と、制御ゲインG1を増加側に補正する速度域との間において、制御ゲインG1が急激に変化することを防止でき、その結果、制御ゲインG1の急激な変化に伴う速度変動や衝撃の発生を回避することができる。   Further, the control gain correction means 18 has a correction calculation pattern (patterns B and C) for changing the correction value h multiplied by the control gain G1 in accordance with the speed command ωd, and the correction value h in the correction calculation pattern And a second speed threshold value ωd1 larger than the speed threshold value ωd0, and when the speed command ωd is equal to or less than the speed threshold value ωd0, the control gain G1 is decreased using the minimum value hmin. When the speed command ωd exceeds the second speed threshold value ωd1, the control gain G1 is corrected to the increasing side using the maximum value hmax, the speed command ωd exceeds the speed threshold value ωd0, and When the speed is less than the second speed threshold value ωd1, the control gain G1 is corrected to the decrease side or the increase side using a correction value proportional to the speed command ωd, so the control gain G1 is corrected to the decrease side. Between the speed range and the speed range where the control gain G1 is corrected to the increase side, the control gain G1 can be prevented from changing abruptly. Can be avoided.

また、制御ゲイン補正手段18は、速度指令ωdと速度フィードバック信号ωの比較にもとづいて加速時であるか減速時であるかを判断すると共に、加速時と減速時では異なる補正演算パターンを用いて制御ゲインG1を補正するので、加速時と減速時の特性の違いが反映された制御ゲインG1の補正を行うことができる。   The control gain correction means 18 determines whether the vehicle is accelerating or decelerating based on the comparison between the speed command ωd and the speed feedback signal ω, and uses different correction calculation patterns during acceleration and deceleration. Since the control gain G1 is corrected, it is possible to correct the control gain G1 reflecting the difference in characteristics between acceleration and deceleration.

次に、本発明の第二実施形態に係る電動機トルク制御装置10Bについて、図8を参照して説明する。但し、前記実施形態と共通する部分については、前記実施形態を同じ符号を付与することにより、前記実施形態の説明を援用する。   Next, an electric motor torque control device 10B according to a second embodiment of the present invention will be described with reference to FIG. However, about the part which is common in the said embodiment, the description of the said embodiment is used by providing the same code | symbol as the said embodiment.

図8は、第二実施形態に係る制御ブロック図であって、第二実施形態の電動機トルク制御装置10Bは、補正前の制御ゲインG1にもとづいてトルク指令Trdを演算した後に、演算したトルク指令Trdを補正値hにもとづいて補正する点が前記実施形態と相違している。このような電動機トルク制御装置10Bであっても、前記実施形態と同等な効果を奏することが可能であるが、時定数パラメータT1も補正値hの影響を受けるので、PI制御では注意が必要である。   FIG. 8 is a control block diagram according to the second embodiment, in which the motor torque control device 10B of the second embodiment calculates the torque command Trd after calculating the torque command Trd based on the control gain G1 before correction. The point which correct | amends Trd based on the correction value h is different from the said embodiment. Even with such an electric motor torque control device 10B, it is possible to achieve the same effects as in the above embodiment, but the time constant parameter T1 is also affected by the correction value h, and therefore caution is required in PI control. is there.

次に、本発明の第三実施形態に係る電動機トルク制御装置10Cについて、図9及び図10を参照して説明する。但し、前記実施形態と共通する部分については、前記実施形態を同じ符号を付与することにより、前記実施形態の説明を援用する。   Next, an electric motor torque control apparatus 10C according to a third embodiment of the present invention will be described with reference to FIGS. However, about the part which is common in the said embodiment, the description of the said embodiment is used by providing the same code | symbol as the said embodiment.

図9は、第三実施形態に係る制御ブロック図、図10は、第三実施形態に係る制御ゲインの補正演算パターンを示す説明図であって、第三実施形態の電動機トルク制御装置10Cは、電動機9の速度フィードバック信号ω(ωa)にもとづいて制御ゲインG1を補正する点が前記実施形態と相違している。このようにすると、速度フィードバック信号ωにもとづいて制御ゲインG1を補正するにあたり、上部旋回体3の速度フィードバック信号ω(ωb)を用いる場合に比べ、減速機8のバックラッシュに起因する速度変動を明確に把握して制御に反映することができる。   FIG. 9 is a control block diagram according to the third embodiment, and FIG. 10 is an explanatory diagram showing a control gain correction calculation pattern according to the third embodiment. An electric motor torque control device 10C according to the third embodiment includes: The point which correct | amends the control gain G1 based on the speed feedback signal (omega) (omegaa) of the electric motor 9 is different from the said embodiment. In this way, when the control gain G1 is corrected based on the speed feedback signal ω, the speed fluctuation caused by the backlash of the speed reducer 8 is reduced as compared with the case where the speed feedback signal ω (ωb) of the upper swing body 3 is used. It can be clearly understood and reflected in the control.

1 油圧ショベル
3 上部旋回体
8 減速機
9 電動機
10 電動機トルク制御装置
11 操作レバー
12 操作位置検出手段
13a 電動機速度検出手段
13b 旋回体速度検出手段
14 速度指令演算手段
15 速度フィードバック信号読込手段
16 速度偏差演算手段
17 トルク指令演算手段
18 制御ゲイン補正手段
DESCRIPTION OF SYMBOLS 1 Hydraulic excavator 3 Upper turning body 8 Reduction gear 9 Electric motor 10 Motor torque control apparatus 11 Operation lever 12 Operation position detection means 13a Motor speed detection means 13b Revolving body speed detection means 14 Speed command calculation means 15 Speed feedback signal reading means 16 Speed deviation Calculation means 17 Torque command calculation means 18 Control gain correction means

Claims (4)

ギヤ機構を介して作動体を電動機に連繋し、該電動機のトルク制御にもとづいて前記作動体を作動させる作業機械の電動機トルク制御装置であって、
該電動機トルク制御装置は、
前記作動体を操作する操作具の操作位置にもとづいて速度指令を演算する速度指令演算手段と、
前記電動機及び/又は前記作動体の速度フィードバック信号を読み込む速度フィードバック信号読込手段と、
前記速度指令と前記速度フィードバック信号との速度偏差を演算する速度偏差演算手段と、
前記速度偏差にもとづいて前記電動機のトルク指令を演算するトルク指令演算手段と、
前記トルク指令の演算に用いる制御ゲインを補正する制御ゲイン補正手段とを備え、
該制御ゲイン補正手段は、前記ギヤ機構のバックラッシュが影響する速度域の上限を定める速度閾値を備えると共に、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値以下のとき、前記制御ゲインを減少側に補正することを特徴とする作業機械の電動機トルク制御装置。
An electric motor torque control device for a working machine, wherein an operating body is linked to an electric motor via a gear mechanism, and the operating body is operated based on torque control of the electric motor,
The electric motor torque control device
Speed command calculating means for calculating a speed command based on an operation position of an operating tool for operating the operating body;
Speed feedback signal reading means for reading a speed feedback signal of the electric motor and / or the operating body;
Speed deviation calculating means for calculating a speed deviation between the speed command and the speed feedback signal;
Torque command calculating means for calculating a torque command of the electric motor based on the speed deviation;
Control gain correction means for correcting the control gain used for the calculation of the torque command,
The control gain correction means includes a speed threshold value that determines an upper limit of a speed range in which the backlash of the gear mechanism affects, and when the speed command or the speed feedback signal of the motor is equal to or lower than the speed threshold value, the control gain correction means A motor torque control device for a work machine, wherein the motor torque control device corrects to a decrease side.
前記制御ゲイン補正手段は、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値を超えているとき、前記制御ゲインを増加側に補正することを特徴とする請求項1記載の作業機械の電動機トルク制御装置。   2. The electric motor for a work machine according to claim 1, wherein the control gain correction means corrects the control gain to an increase side when the speed command or a speed feedback signal of the electric motor exceeds the speed threshold. Torque control device. 前記制御ゲイン補正手段は、前記制御ゲインに乗算される補正値を、前記速度指令又は前記電動機の速度フィードバック信号に応じて変化させる補正演算パターンを有し、該補正演算パターンにおける補正値の最大値及び最小値を定めると共に、前記速度閾値よりも大きい第二の速度閾値を備え、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値以下のときは、前記最小値を用いて前記制御ゲインを減少側に補正し、前記速度指令又は前記電動機の速度フィードバック信号が前記第二の速度閾値を超えているときは、前記最大値を用いて前記制御ゲインを増加側に補正し、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値を超え、かつ、前記第二の速度閾値以下のときは、前記速度指令又は前記電動機の速度フィードバック信号に比例する補正値を用いて前記制御ゲインを減少側又は増加側に補正することを特徴とする請求項2記載の作業機械の電動機トルク制御装置。   The control gain correction means has a correction calculation pattern for changing a correction value multiplied by the control gain in accordance with the speed command or the speed feedback signal of the motor, and the maximum value of the correction value in the correction calculation pattern And a second speed threshold value that is larger than the speed threshold value, and when the speed command or the speed feedback signal of the motor is equal to or lower than the speed threshold value, the control gain is set using the minimum value. When the speed command or the speed feedback signal of the motor exceeds the second speed threshold value, the control gain is corrected to the increase side using the maximum value, and the speed command or When the speed feedback signal of the motor exceeds the speed threshold and is equal to or lower than the second speed threshold, the speed command or the electric power Working machine motor torque control apparatus according to claim 2, wherein the correcting the reduction side or the increase side the control gain by using the correction value proportional to the speed feedback signal of the machine. 前記制御ゲイン補正手段は、前記速度指令と前記速度フィードバック信号の比較にもとづいて加速時であるか減速時であるかを判断すると共に、加速時と減速時では異なる補正演算パターンを用いて前記制御ゲインを補正することを特徴とする請求項1〜3のいずれか一項に記載の作業機械の電動機トルク制御装置。   The control gain correction means determines whether the vehicle is accelerating or decelerating based on a comparison between the speed command and the speed feedback signal, and uses the different correction calculation patterns for acceleration and deceleration. The motor torque control device for a work machine according to any one of claims 1 to 3, wherein the gain is corrected.
JP2010142743A 2010-06-23 2010-06-23 Electric motor torque control device for work machines Expired - Fee Related JP5652857B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010142743A JP5652857B2 (en) 2010-06-23 2010-06-23 Electric motor torque control device for work machines

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010142743A JP5652857B2 (en) 2010-06-23 2010-06-23 Electric motor torque control device for work machines

Publications (2)

Publication Number Publication Date
JP2012007334A true JP2012007334A (en) 2012-01-12
JP5652857B2 JP5652857B2 (en) 2015-01-14

Family

ID=45538174

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010142743A Expired - Fee Related JP5652857B2 (en) 2010-06-23 2010-06-23 Electric motor torque control device for work machines

Country Status (1)

Country Link
JP (1) JP5652857B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015196967A (en) * 2014-03-31 2015-11-09 住友重機械工業株式会社 Shovel
WO2016152650A1 (en) * 2015-03-24 2016-09-29 住友重機械工業株式会社 Slewing device
CN114509994A (en) * 2022-01-04 2022-05-17 苏州伟创电气科技股份有限公司 Adjusting method, adjusting device, servo system, electronic equipment and storage medium

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS642110A (en) * 1987-06-24 1989-01-06 Fanuc Ltd Backlash control system
JP2005273262A (en) * 2004-03-24 2005-10-06 Sumitomo (Shi) Construction Machinery Manufacturing Co Ltd Swing device of construction machinery
WO2006033401A1 (en) * 2004-09-24 2006-03-30 Komatsu Ltd. Gear drive controller, gear drive control method, turning operation controller, and construction machine
JP2008115640A (en) * 2006-11-07 2008-05-22 Shin Caterpillar Mitsubishi Ltd Revolving control device of work machine
JP2009163590A (en) * 2008-01-09 2009-07-23 Mitsubishi Heavy Ind Ltd Lost motion cancellation control apparatus

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS642110A (en) * 1987-06-24 1989-01-06 Fanuc Ltd Backlash control system
JP2005273262A (en) * 2004-03-24 2005-10-06 Sumitomo (Shi) Construction Machinery Manufacturing Co Ltd Swing device of construction machinery
WO2006033401A1 (en) * 2004-09-24 2006-03-30 Komatsu Ltd. Gear drive controller, gear drive control method, turning operation controller, and construction machine
JP2008115640A (en) * 2006-11-07 2008-05-22 Shin Caterpillar Mitsubishi Ltd Revolving control device of work machine
JP2009163590A (en) * 2008-01-09 2009-07-23 Mitsubishi Heavy Ind Ltd Lost motion cancellation control apparatus

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015196967A (en) * 2014-03-31 2015-11-09 住友重機械工業株式会社 Shovel
WO2016152650A1 (en) * 2015-03-24 2016-09-29 住友重機械工業株式会社 Slewing device
CN107251409A (en) * 2015-03-24 2017-10-13 住友重机械工业株式会社 Slewing equipment
JPWO2016152650A1 (en) * 2015-03-24 2018-01-18 住友重機械工業株式会社 Swivel device
CN107251409B (en) * 2015-03-24 2021-01-29 住友重机械工业株式会社 Turning device
CN114509994A (en) * 2022-01-04 2022-05-17 苏州伟创电气科技股份有限公司 Adjusting method, adjusting device, servo system, electronic equipment and storage medium

Also Published As

Publication number Publication date
JP5652857B2 (en) 2015-01-14

Similar Documents

Publication Publication Date Title
EP1905902B1 (en) Working machine including a rotation control device
JP4793352B2 (en) Swivel control device and work machine equipped with the same
JP4082935B2 (en) Hybrid construction machine
EP1961869B1 (en) Rotation control device and working machine therewith
US8695566B2 (en) Engine control apparatus
JP4167289B2 (en) Swivel control device and construction machine
JP5886323B2 (en) Turning control device and method
KR101379970B1 (en) Rotation control device for working machine
JPWO2006033401A1 (en) Gear drive control device, gear drive control method, turning control device, and construction machine
JP5652857B2 (en) Electric motor torque control device for work machines
JP2003328398A (en) Swing controller for work machine
JP5970625B1 (en) Construction machine, hybrid hydraulic excavator, and motor generator output torque control method
JP2010095906A (en) Construction machine and slewing controlling device
JP2004036303A (en) Turning control device for working machine
JP5364080B2 (en) Electric motor control device, electric motor control method, and construction machine equipped with electric motor control device
EP3085969B1 (en) Construction machine
JP5448186B2 (en) Electric motor torque control device for work machines
WO2012035921A1 (en) Hydraulic pressure device
JP2012010462A (en) Motor torque control device of work machine
JP2009027873A (en) Drive controller for rotating body
WO2015199249A1 (en) Work vehicle and method for controlling same
JP4990212B2 (en) Electric / hydraulic drive for construction machinery
JP2651075B2 (en) Hydraulic actuator control device for earth moving machine
JP2015161217A (en) Control device of construction machine

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20121221

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20131220

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20140123

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140422

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20141113

R150 Certificate of patent or registration of utility model

Ref document number: 5652857

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees