JP2012007334A - Motor torque control device of work machine - Google Patents
Motor torque control device of work machine Download PDFInfo
- 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
Links
Images
Abstract
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
図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
本発明は、上記の如き実情に鑑みこれらの課題を解決することを目的として創作されたものであって、ギヤ機構を介して作動体を電動機に連繋し、該電動機のトルク制御にもとづいて前記作動体を作動させる作業機械の電動機トルク制御装置であって、該電動機トルク制御装置は、前記作動体を操作する操作具の操作位置にもとづいて速度指令を演算する速度指令演算手段と、前記電動機及び/又は前記作動体の速度フィードバック信号を読み込む速度フィードバック信号読込手段と、前記速度指令と前記速度フィードバック信号との速度偏差を演算する速度偏差演算手段と、前記速度偏差にもとづいて前記電動機のトルク指令を演算するトルク指令演算手段と、前記トルク指令の演算に用いる制御ゲインを補正する制御ゲイン補正手段とを備え、該制御ゲイン補正手段は、前記ギヤ機構のバックラッシュが影響する速度域の上限を定める速度閾値を備えると共に、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値以下のとき、前記制御ゲインを減少側に補正することを特徴とする。
また、前記制御ゲイン補正手段は、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値を超えているとき、前記制御ゲインを増加側に補正することを特徴とする。
また、前記制御ゲイン補正手段は、前記制御ゲインに乗算される補正値を、前記速度指令又は前記電動機の速度フィードバック信号に応じて変化させる補正演算パターンを有し、該補正演算パターンにおける補正値の最大値及び最小値を定めると共に、前記速度閾値よりも大きい第二の速度閾値を備え、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値以下のときは、前記最小値を用いて前記制御ゲインを減少側に補正し、前記速度指令又は前記電動機の速度フィードバック信号が前記第二の速度閾値を超えているときは、前記最大値を用いて前記制御ゲインを増加側に補正し、前記速度指令又は前記電動機の速度フィードバック信号が前記速度閾値を超え、かつ、前記第二の速度閾値以下のときは、前記速度指令又は前記電動機の速度フィードバック信号に比例する補正値を用いて前記制御ゲインを減少側又は増加側に補正することを特徴とする。
また、前記制御ゲイン補正手段は、前記速度指令と前記速度フィードバック信号の比較にもとづいて加速時であるか減速時であるかを判断すると共に、加速時と減速時では異なる補正演算パターンを用いて前記制御ゲインを補正することを特徴とする。
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
According to the invention of
According to the invention of
以下、本発明の実施の形態について、図面に基づいて説明する。図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
図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
油圧ショベル1には、電動機9のトルク制御を行う電動機トルク制御装置10が設けられている。本実施形態の電動機トルク制御装置10は、操作レバー(操作具)11の操作位置を検出する操作位置検出手段12、電動機9の速度ωaを検出する電動機速度検出手段13a、上部旋回体3の速度ωbを検出する旋回体速度検出手段13bなどから検出信号を入力すると共に、これらの入力信号に応じて電動機9の駆動トルクを制御するが、制御対象が電動発電機である場合は、駆動トルクだけでなく、回生トルクの制御も行うことができる。
The
電動機トルク制御装置10は、操作レバー11の操作位置にもとづいて速度指令ωdを演算する速度指令演算手段14と、電動機9及び/又は上部旋回体3の速度フィードバック信号ωを読み込む速度フィードバック信号読込手段15と、速度指令ωdと速度フィードバック信号ωとの速度偏差Δωを演算する速度偏差演算手段16と、速度偏差Δωにもとづいて電動機9のトルク指令Trdを演算するトルク指令演算手段17とを備えている。
The motor
トルク指令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
例えば、減速機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
上記のような問題は、制御ゲイン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
また、制御ゲイン補正手段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
また、制御ゲイン補正手段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
図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
次に、速度指令ω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
次に、制御ゲイン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
また、制御ゲイン補正手段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
また、制御ゲイン補正手段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
図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
次に、本発明の第三実施形態に係る電動機トルク制御装置10Cについて、図9及び図10を参照して説明する。但し、前記実施形態と共通する部分については、前記実施形態を同じ符号を付与することにより、前記実施形態の説明を援用する。
Next, an electric motor
図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
1 油圧ショベル
3 上部旋回体
8 減速機
9 電動機
10 電動機トルク制御装置
11 操作レバー
12 操作位置検出手段
13a 電動機速度検出手段
13b 旋回体速度検出手段
14 速度指令演算手段
15 速度フィードバック信号読込手段
16 速度偏差演算手段
17 トルク指令演算手段
18 制御ゲイン補正手段
DESCRIPTION OF
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.
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)
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)
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 |
-
2010
- 2010-06-23 JP JP2010142743A patent/JP5652857B2/en not_active Expired - Fee Related
Patent Citations (5)
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)
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 |