JP4793352B2 - 旋回制御装置及びこれを備えた作業機械 - Google Patents

旋回制御装置及びこれを備えた作業機械 Download PDF

Info

Publication number
JP4793352B2
JP4793352B2 JP2007221183A JP2007221183A JP4793352B2 JP 4793352 B2 JP4793352 B2 JP 4793352B2 JP 2007221183 A JP2007221183 A JP 2007221183A JP 2007221183 A JP2007221183 A JP 2007221183A JP 4793352 B2 JP4793352 B2 JP 4793352B2
Authority
JP
Japan
Prior art keywords
torque
speed
target
target torque
turning
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
Application number
JP2007221183A
Other languages
English (en)
Other versions
JP2008231903A (ja
Inventor
昌之 鹿児島
昭 筒井
昌之 小見山
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.)
Kobelco Construction Machinery Co Ltd
Original Assignee
Kobelco Construction Machinery Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kobelco Construction Machinery Co Ltd filed Critical Kobelco Construction Machinery Co Ltd
Priority to JP2007221183A priority Critical patent/JP4793352B2/ja
Priority to US12/034,331 priority patent/US8190334B2/en
Priority to EP08151686.6A priority patent/EP1961869B1/en
Priority to EP10174647.7A priority patent/EP2275606B1/en
Priority to CN200810080597XA priority patent/CN101250888B/zh
Publication of JP2008231903A publication Critical patent/JP2008231903A/ja
Application granted granted Critical
Publication of JP4793352B2 publication Critical patent/JP4793352B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/08Superstructures; Supports for superstructures
    • E02F9/10Supports for movable superstructures mounted on travelling or walking gears or on other superstructures
    • E02F9/12Slewing or traversing gears
    • E02F9/121Turntables, i.e. structure rotatable about 360°
    • E02F9/123Drives or control devices specially adapted therefor
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/08Superstructures; Supports for superstructures
    • E02F9/10Supports for movable superstructures mounted on travelling or walking gears or on other superstructures
    • E02F9/12Slewing or traversing gears
    • E02F9/121Turntables, i.e. structure rotatable about 360°
    • E02F9/128Braking systems
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2058Electric or electro-mechanical or mechanical control devices of vehicle sub-units
    • E02F9/2062Control of propulsion units
    • E02F9/207Control of propulsion units of the type electric propulsion units, e.g. electric motors or generators

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Operation Control Of Excavators (AREA)
  • Jib Cranes (AREA)
  • Control Of Electric Motors In General (AREA)

Description

本発明は、電動機によって旋回体を旋回駆動するショベルやクレーン等の作業機械の旋回制御装置に関するものである。
従来、ショベルやクレーン等の旋回作業機械においては、油圧ポンプの吐出油により駆動する油圧モータを旋回体の旋回駆動源として利用していた。
これに対し、近年では、旋回体を電動機で旋回させる技術が知られている(例えば、特許文献1)。
このように旋回体を電動機で旋回させる技術では、旋回操作レバーの操作量に応じて目標速度を設定し、この目標速度と実際の旋回速度との偏差を用いてトルク指令を決定する速度制御(いわゆる、速度フィードバック制御)が行われている。
前記速度フィードバック制御では、速度に対する追従性を向上させるために、例えばPID制御の場合であればゲインをできる限り大きくすることが行われている。しかしながら、ゲインを大きくした場合には、目標速度と実際の旋回速度との偏差が小さくても、僅かなレバー操作で電動機への指令トルクが大きくなり過ぎるため、例えば、バケットによる旋回押付作業を行なう場合にはその押付力の調整が困難となることがある。さらに、急激なレバー操作を行なった場合には、電動機への指令トルクが急激に大きくなってショックを生じさせることもある。
反対に、レバー操作での電動機への指令トルクの調整を行い易くするために、例えばPID制御の場合であればゲインを小さくする、又は積分ゲインを零とすることが行われている。しかしながら、ゲインを小さくした場合には、傾斜地での作業状態(作業機械自体の自重を受けている状態)等において、電動機への指令トルクが小さくなり過ぎて、充分な加減速トルクやその場保持トルクを確保することができないという問題が生じることがある。
前記速度フィードバック制御の問題を解決するための技術として、特許文献2〜5に記載されたものが知られている。これら特許文献2〜5は前記2つの制御系を適宜切り換えるようにしたものである。
具体的に、特許文献2は、操作レバーの特定の操作量を境として速度フィードバック制御とトルク制御とを切り換えるようにした技術を開示している。特許文献3は、操作レバーの操作量に応じた目標速度の速度閾値を境として速度制御と位置制御とを切り換えるようにした技術を開示している。特許文献4は、旋回体の所定の速度を境として通常の速度制御とこの速度制御よりも比例ゲインを低くした速度制御とを切り換えるようにした技術を開示している。
また、特許文献5は、操作レバーのレバー操作量が予め設定された中立範囲にあるときには位置保持制御を行う一方、レバー操作量が前記中立範囲を超えたときには、トルク制御を行う技術を開示している。具体的に、特許文献5の技術では、前記中立範囲内で行われる位置保持制御において特定されたその場保持トルクをコントローラに記憶しておき、前記中立範囲を超えたときには、前記記憶されたその場保持トルク、レバー操作量に応じた加速トルクのうち、大きい方のトルクによって旋回体を旋回駆動するようになっている。
特開2001−10783号公報 特開2003−328398号公報 国際公開第2005/111322号パンフレット 特開2005−273262号公報 特開2004−36303号公報
しかしながら、前記特許文献2〜5のように2つの制御系を切り換える場合には、当該制御系の切り換え点において、これら制御系同士の間のギャップを補間するためにトルクが不連続に変動(急激に変動)し、スムーズで安定した制御を行うことができなかった。
また、特許文献5の技術では、レバー操作量が中立範囲を超えた後の状態においては、その場保持トルク、加速トルクのうち大きい方のトルクによって旋回駆動を行うようにしているが、ここで、前記その場保持トルクは中立範囲内で実行された位置保持制御で生じた過去に必要であったトルクであり、現時点での作業状態を反映させたものではないため、前記位置保持制御の実行時よりもトルク制御の実行時の方が旋回体をその場で保持させるためのトルクが大きい作業状態(例えば、傾斜地での作業)となっているときには、旋回体がオペレータの意思に反して逆行してしまうおそれがある。
本発明は、上記課題に鑑みてなされたものであり、トルクの不連続な変動を抑制しながら、旋回体の逆行を防止することができる作業機械の旋回制御装置及びこれを備えた作業機械を提供することを目的としている。
上記課題を解決するために、本発明は、本体と、この本体に旋回可能に搭載された旋回体と、この旋回体に起伏可能に設けられた作業アタッチメントとを有する作業機械に設けられた旋回制御装置であって、前記旋回体を旋回駆動するための電動機と、この電動機に対する駆動指示の入力操作を受ける操作手段と、この操作手段の操作量を検出可能な操作量検出手段と、前記電動機の回転速度を検出可能な速度検出手段と、前記操作量検出手段により検出された操作量に対応する目標速度で前記電動機を駆動させるための第一目標トルクを設定するとともに、前記速度検出手段により検出された現実の速度に基づいて前記旋回体をその場で保持させるための第二目標トルクを設定し、これら第一目標トルク、第二目標トルクのうち、前記第一目標トルクと同じ方向のトルクであって絶対値の大きなトルクに応じて前記電動機を作動させる制御手段とを備えていることを特徴とする作業機械の旋回制御装置を提供する。
本発明によれば、速度検出手段により検出された現実の速度に基づいて前記第二目標トルクを設定しているため、作業状態が逐一変動する環境で作業を行なっている場合であっても、現時点における作業状態に適したその場保持トルク(第二目標トルク)を特定することができる。つまり、作業アタッチメントの作動状態(作業アタッチメントの作業半径、又は作業時におけるバケット内の土砂の有無等)、又は作業時に受ける外力(バケットによる押付作業時に受ける外力、傾斜地における作業機械自体の自重等)等に応じて前記その場保持トルクが逐一変動することになるが、本発明によれば、このような場合であっても旋回体の逆行を確実に防止することができる。
さらに、本発明では、上記のように算出された第二目標トルクと、操作手段の操作量に基づいて算出された第二目標トルクとの間で高位選択を行うようにしているため、これら第一目標トルク及び第二目標トルクの推移するチャートを検討したとき(図13参照)に、これらのチャートが交差する点(図13の(b)のL8)を境として選択されるトルクが変更されることになる。このように、本発明によれば、トルク以外の特定の要素を境として制御系を切り換える従来技術と異なり、常に第一、第二目標トルクの大小比較を行い、大きいものを採用しているため、トルクの不連続な変動を抑制することができる。
具体的に、前記制御手段は、前記操作量検出手段により検出された操作量に基づいて前記目標速度を設定する目標速度設定手段と、前記目標速度と前記速度検出手段により検出された現実の速度との速度偏差に基づいて前記第一目標トルクを算出する第一トルク演算手段と、前記第一目標トルク、第二目標トルクのうち、前記第一目標トルクと同じ方向のトルクであって絶対値の大きなトルクを次の目標トルクとして設定する目標トルク設定手段とを備えている構成とすることができる。
さらに、前記制御手段は、前記現実の速度を零にするために前記電動機に与えるべきトルクを前記第二目標トルクとして算出する第二トルク演算手段を備えている構成とすることができる。
なお、「零」とは、速度が完全に零になっている場合だけでなく、実質的に零になっていると判断することができる範囲の速度成分を含んでいるものも含む趣旨である。
そして、前記第一トルク演算手段及び第二トルク演算手段は、それぞれ比例項と積分項とを有する数式に従って第一目標トルク及び第二目標トルクを算出するようになっており、前記制御手段は、前記比例項及び積分項に乗されるゲインの大小を変更可能なゲイン変更手段をさらに備えていることが好ましい。
この構成によれば、ゲイン変更手段により比例積分制御における各ゲインを調整することができるので、作業アタッチメントの作業半径が大きいとき、傾斜地での作業等のように旋回体の慣性モーメントが大きいときには、ゲインを大きめに変更すれば逆行を確実に防ぐことができる。一方、バケットによる旋回押付作業等を行う場合には、ゲインを小さめに変更すれば操作手段の操作に応じてトルクの微調整を行うことが可能となる。
また、本発明は、機体と、この機体に対し旋回可能に搭載された旋回体と、前記旋回制御装置とを備えた作業機械を提供する。
本発明によれば、トルクの不連続な変動を抑制しながら、旋回体の逆行を防止することができる。
以下、本発明の好ましい実施形態について図面を参照して説明する。
図1は、本発明の実施形態に係るショベルの全体構成を示す側面図を示している。図2は、図1のショベルの駆動・制御系の構成を示すブロック図である。
図1及び図2を参照して、作業機械の一例としてのショベル1は、クローラ式の下部走行体2と、この下部走行体2上に旋回可能に搭載された上部旋回体3と、この上部旋回体3の前部に装着された作業アタッチメント4とを備えている。
作業アタッチメント4は、前記上部旋回体3に起伏可能に装着されたブーム5と、このブーム5の先端部に連結されたアーム6と、このアーム6の先端に連結されたバケット7と、前記ブーム5を上部旋回体3に対して駆動させるブームシリンダ8と、前記アーム6をブーム5に対して駆動させるアームシリンダ9と、前記バケット7をアーム6に対して駆動させるバケットシリンダ10とを備えている。
下部走行体2は、左右一対のクローラ11(図1では1つ示している)を備え、これらクローラ11にはそれぞれ走行モータ12が設けられている。
上部旋回体3は、エンジン14と、このエンジン14によって駆動される油圧ポンプ15及び発電機16と、バッテリ17と、旋回用電動機18と、この旋回用電動機18の減速機構19とを備えている。
図2に示すように、油圧ポンプ15は、ブームシリンダ8、アームシリンダ9、バケットシリンダ10及び走行モータ12(以下、油圧アクチュエータ8〜10、12と総称す
る)に対し、それぞれコントロールバルブ20を介して作動油を供給するようになっている。換言すると、前記コントロールバルブ20の操作に応じて油圧ポンプ15から油圧アクチュエータ8〜10、12への作動油流量等を調整することにより、油圧アクチュエータ8〜10、12の動作が制御される。
発電機16は、増速機構21を介してエンジン14の出力軸に連結されている。この発電機16で得られた電力は、制御器22を介してバッテリ17に充電されるとともに、インバータ23を介して旋回用電動機18に供給される。なお、前記制御器22は、電圧の印加や電流の供給を調整するためのものである。
旋回用電動機18は、機械的ブレーキ力を発生させるためのネガティブブレーキとしてのメカニカルブレーキ24を備えている。このメカニカルブレーキ24が解除された状態で、旋回用電動機18の駆動力が旋回用減速機構19を経由して下部走行体2に伝達することにより、当該下部走行体2に対して上部旋回体3が右又は左に旋回する。
また、上部旋回体3は、操作レバー25を備えている。この操作レバー25は、予め設定された中立位置から左右に傾動操作可能なレバー部25aと、このレバー部25aの操作量を検出する操作部(例えば、ポテンショメータ)25bとを備え、前記レバー部25aの操作量に応じた電気信号を制御手段の一例であるコントローラ26に出力するようになっている。
さらに、上部旋回体3は、旋回用電動機18の回転速度(旋回速度)を検出する速度センサ27を備えている。この速度センサ27は、旋回用電動機18の回転速度に応じた電気信号をコントローラ26に出力するようになっている。
コントローラ26は、各種演算処理を実行するCPU、初期設定等を記憶するROM、及び各種情報を書き換え可能に記憶するRAM等からなる周知の制御手段である。このコントローラ26には、図3に示すような目標速度マップが記憶されている。
具体的に、図3の目標速度マップは、操作レバー25の操作量(傾動角度)が大きくなるに従い大きな目標速度が選択されるように、操作レバー25のレバー部25aの両操作方向(右旋回又は左旋回方向)のそれぞれについて設定されたものである。このマップに設定された目標速度は、操作レバー25の操作量の増減に応じて滑らかに増減するように、急激な増減を伴わない曲線として設定されている。
図4は、図2のコントローラの電気的構成を示すブロック図である。
図4を参照して、コントローラ26は、前記目標速度のマップに基づいて目標速度を設定する目標速度設定部28と、前記目標速度の補正量を算出する補正量算出部29と、前記目標速度と補正量と実際の速度とに基づいて第一目標トルクを算出する第一トルク演算部(第一トルク演算手段)30と、前記速度センサ27により検出された速度を零にする(検出された速度が零の場合にはその状態を保持する)ために旋回用電動機18に対して与えるべき第二目標トルクを演算する第二トルク演算部(第二トルク演算手段)31と、前記第一目標トルク及び第二目標トルクのうち、前記第一目標トルクの方向(右旋回方向又は左旋回方向)と同じ方向のトルクであって絶対値の大きいものを次の目標トルクとして設定する目標トルク設定部(目標トルク設定手段)32とを備えている。
目標速度設定部28は、前記操作レバー25の操作量a0に対応する目標速度v0を、前記目標速度マップ(図3参照)から特定する。
補正量算出部29は、現時点におけるショベル1の作業状態に応じて変化する旋回用電動機18を旋回させるための必要トルクt0を検出する。ここで、「ショベル1の作業状態」とは、例えば、作業アタッチメント4の作動状態(作業アタッチメント4の作業半径、又は作業時におけるバケット7内の土砂の有無等)や、作業時に受ける反力(バケット7による押付作業時に受ける反力、傾斜地におけるショベル1自体の自重等)のことである。具体的に、補正量算出部29は、本実施形態では1周期前にインバータ23から出力した目標トルクを旋回用電動機18の前記必要トルクt0に相当するものとして利用し、この必要トルクt0と操作部25bの操作量a0とに基づいて下記数式1に従い補正量b0を算出する。
Figure 0004793352
ここで、G0及びG1はそれぞれ制御ゲインであり、前記操作部25bの操作量a0を変数としたときの切片及び勾配に相当するものである。つまり、制御ゲインG0は、制限することができるトルクの最大値を規定するものであり、この制御ゲインG0を大きくするほど最終的に算出される目標トルクの値が小さくなる。一方、制御ゲインG1は、操作レバー25の操作量a0の変化に応じて制限することができるトルクの増減の割合を規定するためのものである。そして、これら制御ゲインG0、G1を調整することにより、油圧旋回システムにおけるブリードオフに相当する効果を得ることができる。
なお、本実施形態では、1周期前の目標トルクを旋回用電動機18の必要トルクt0に相当するものとして利用しているが、前記1周期前の目標トルクと速度センサ27により検出された旋回用電動機18の速度とに基づいて当該旋回用電動機18の実際の必要トルクを算出してもよい。
そして、下記数式2に示すように、補正量算出部29により算出された補正量b0及び前記速度センサ27により検出された旋回用電動機18の実際の速度v1が、前記目標速度v0から減算されて速度偏差Δvが算出される。
Figure 0004793352
第一トルク演算部30は、前記速度偏差Δvに基づいて下記数式3に従い第一目標トル
クt1を算出する。
Figure 0004793352
ここで、G2は比例ゲイン、G3は積分ゲインであり、それぞれ予め設定されたものである。
一方、第二トルク演算部31は、操作レバー25のレバー部25aの操作位置が上述した中立範囲内にあるときに、前記速度センサ27により検出された旋回用電動機18の実際の速度v1を零にするために旋回用電動機18に対して与えるべき第二目標トルクt2を下記数式4に従い算出する。
Figure 0004793352
ここで、G4は比例ゲイン、G5は積分ゲインであり、それぞれ予め設定されたものである。
目標トルク設定部32は、前記第一目標トルクt1及び第二目標トルクt2のうち、前記第一目標トルクt1の方向(以下、右旋回方向を「正」の方向、左旋回方向を「負」の方向として説明する)と同じ方向のトルクであって絶対値の大きいものを次の目標トルクとして設定するようになっている。
以下、前記コントローラ26により実行される処理について図4及び図5を参照して説明する。
処理が開始されると、まず、操作レバー25の操作量a0に対応する目標速度v0をマップ(図3参照)に基づいて特定する(ステップS1)。
次に、前記速度センサ27により旋回用電動機18の速度v1を検出するとともに(ステップS2)、この速度v1に基づいて前記数式4に従い第二目標トルクt2を算出する(ステップS3)。
そして、前記数式1に従い補正量b0を算出するとともに、この補正量b0及び前記速度v1を利用して前記数式2に従い速度偏差Δvを算出する(ステップS4)。
次いで、前記速度偏差Δvを用いて前記数式3に従い第一目標トルクt1を算出するとともに(ステップS5)、この第一目標トルクt1が正方向(右旋回方向)であるか否かを判定する(ステップS6)。
ここで、第一目標トルクt1が正の方向(右旋回方向)である場合(ステップS6でYES)、第一目標トルクt1と第二目標トルクt2とを比較して(ステップS7)、第一目標トルクt1、第二目標トルクt2のうち、正の方向のトルクであって、その絶対値が大きいものを次の目標トルクとして設定する(ステップS8、S9)。そして、このように設定された目標トルクを前記インバータ23に出力して(ステップS15)、当該処理を終了する。
一方、第一目標トルクt1が正の方向ではない場合(ステップS6でNO)には、当該第一目標トルクt1が負の方向(左旋回方向)であるか否かを判定する(ステップS10)。
ここで、第一目標トルクt1が負の方向(左旋回方向)である場合(ステップS10でYES)、第一目標トルクt1と第二目標トルクt2とを比較して(ステップS11)、第一目標トルクt1、第二目標トルクt2のうち、負の方向のトルクであって、その絶対値が大きいもの、つまり、正負の符号を考慮した場合に小さい方のものを、次の目標トルクとして設定する(ステップS12、S13)。そして、このように設定された目標トルクを前記インバータ23に出力して(ステップS15)、当該処理を終了する。
さらに、前記ステップS6及びS10において、第一目標トルクt1が正及び負の何れの方向でもないと判断された場合(ステップS6及びS10でNO)、つまり、上部旋回体3をその場で保持させる必要がある場合には、前記第二目標トルクt2を次の目標トルクとして設定し(ステップS14)、次いで、このように設定された目標トルクを前記インバータ23に出力して(ステップS15)、当該処理を終了する。
前記のような処理を行うことにより、図6に示すように、操作レバー25の操作に応じたトルク制御が可能となる。
図6は、ショベル1のバケット7を地面に押し当てた状態で、操作レバー25を操作した場合における、当該操作レバー25の操作状態、旋回トルク及び旋回速度をそれぞれ示したものである。
つまり、図6の状態においては、バケット7が地面に押し当てられて上部旋回体3が旋回し得ない状態で操作レバー25が操作された状態を示している。このような場合、従来のように必要トルクt0を加味せずにPID制御を行うと、操作レバー25の操作量の増加に応じて目標速度が高くなっていくのに対し実際の速度が零のままであるため、速度偏差が著しく大きくなり、図7の中段に示すように、トルク増加が急激なものとなりショックが生じるおそれがあるが、前記実施形態のように、旋回用電動機18の必要トルクt0に基づく補正量b0の分だけ速度偏差Δvを小さくすることにより、図6の中段に示すように操作レバー25の操作に応じた旋回トルクを生じさせることができる。このことは、操作レバー25の操作量と旋回トルクとの関係を示す図8からも明らかである。なお、図8も図6と同様に、バケット7が地面に押し当てられて上部旋回体3が旋回し得ない状態における旋回トルクを示したものである。
また、図9は、上部旋回体に生じている必要トルクt0が比較的小さい場合における操作レバーの操作量、旋回速度及び旋回トルクをそれぞれ示したものである。
上述した数式1に示すように、補正量b0は必要トルクt0が小さくなるほど零に近づくため、必要トルクt0が小さい場合には、当該必要トルクt0を加味しない従来技術と同様の速度制御を行うことができる。参考として、図10に必要トルクt0を加味しない場合における操作レバーの操作量、旋回速度及び旋回トルクを示す。なお、旋回速度の欄における実線は実際の旋回速度を示しており、二点鎖線は操作レバー25の操作量に対応する目標速度をそれぞれ示している。
さらに、前記実施形態では、上述のように第一目標トルクt1、第二目標トルクt2のうち、第一目標トルクt1と同方向のトルクであって絶対値の大きいものを次の目標トルクとして設定するようにしているため、トルクの変動をスムーズに行うことができる。以下、この点について従来の構成と対比しながら説明する。
以下の説明では、図11に示すように操作レバー25の操作量L1を時間の経過とともに大きくしていくことに応じて、旋回用電動機18の目標速度がL2に示すように推移する場合について説明する。なお、チャートL2が2秒付近から立ち上がっていることからも明らかなように、0秒〜2秒の範囲内における操作レバー25の操作範囲は不感帯(あそび)とされている。
例えば、特開2003−328398号公報に開示された従来の技術では、操作レバーの操作量が前記不感帯の範囲内では速度比例制御(PID制御)を行う一方、操作レバーの操作量が不感帯を超えた場合にトルク制御を行うようになっている。つまり、図12の(a)に示すように速度比例制御が行われるときのトルク推移L3と、上部旋回体をその場に保持させるためのトルク推移L4とを考慮した場合に、操作レバーの操作量を徐々に大きくしていくと、図12の(b)に示すように、0秒〜2秒までの不感帯の範囲内ではトルク推移L4に従いトルクが推移するが、前記不感帯の範囲を超えて操作レバーが操作されると、その時点からトルク推移L3に従ったトルク制御が実行されるため、当該不感帯の終端まで操作されたときに、トルク推移L3とL4とを補間するための不連続部分L5が生じることになる。
これに対し、前記実施形態では、図13の(a)に示すように、速度比例制御が行われるときの第一目標トルクL6と、上部旋回体3をその場に保持させるための第二目標トルクL7とを常時比較して、これら第一目標トルクL6、第二目標トルクL7のうちの大きなものを選択するようにしている。そのため、図13の(b)に示すように、本実施形態では、操作レバー25の操作量にかかわらず、第一目標トルクL6と第二目標トルクL7との交点部分L8を境として、これら第一目標トルクL6と第二目標トルクL7とを連続的に切り換えることが可能となる。したがって、本実施形態によれば、スムーズで安定した制御を行うことができる。
以上説明したように、前記実施形態によれば、速度センサ27により検出された現実の速度に基づいて第二目標トルクt2を設定しているため、作業状態が逐一変動する環境で作業を行なっている場合であっても、現時点における作業状態に適したその場保持トルク(第二目標トルクt2)を特定することができる。つまり、作業アタッチメント4の作動状態(作業アタッチメント4の作業半径、又は作業時におけるバケット7内の土砂の有無等)、又は作業時に受ける外力(バケット7による押付作業時に受ける外力、傾斜地における作業機械自体の自重等)等に応じて前記その場保持トルクが逐一変動することになるが、前記実施形態によれば、このような場合であっても上部旋回体の逆行を確実に防止することができる。
さらに、前記実施形態では、上記のように算出された第二目標トルクt2と、操作レバー25の操作量に基づいて算出された第二目標トルクt2との間で高位選択(図5のステップS6〜S14)を行うようにしているため、これらの第一目標トルクt1及び第二目標トルクt2の推移するチャートL6、L7を検討したとき(図13参照)に、これらのチャートL6、L7の交点部分L8を境として選択されるトルクが変更されることになる。このように前記実施形態によれば、トルク以外の特定の要素を境として制御系を切り換える従来技術と異なり、常に第一、第二目標トルクt1、t2の大小比較を行い、大きいものを採用しているため、トルクの不連続な変動を抑制することができる。
なお、前記実施形態では、数式3及び数式4におけるゲインG2、G3、G4及びG5がそれぞれ予め設定された値で固定されている構成について説明しているが、前記コントローラ26に各ゲインG2〜G5を変更するためのゲイン変更手段を設けることができる。
このようにすれば、ゲイン変更手段により各ゲインG2〜G5を調整することができるので、作業アタッチメント4の作業半径が大きいとき、傾斜地での作業等のように旋回体の慣性モーメントが大きいときには、ゲインG2〜G5を大きめに設定すれば逆行を確実に防ぐことができる。一方、バケット7による旋回押付作業等を行なう場合には、ゲインを小さめに変更すれば操作レバー25の操作に応じてトルクの微調整を行うことが可能となる。
また、前記実施形態では、上部旋回体3の作業状態に応じて変化する当該上部旋回体3を旋回させるための必要トルクt0(1周期前の目標トルク)に応じて旋回用電動機18の目標トルクの大きさを調整するように構成されているので、ショックの発生を効果的に抑制することができる。
つまり、前記ショベル1においても、その作業状態、例えば、作業アタッチメント4の作動状態(作業アタッチメント4の作業半径、又は作業時におけるバケット7内の土砂の有無等)、又は作業時に受ける外力(バケット7による押付作業時に受ける反力、傾斜地におけるショベル1自体の自重等)に応じて必要トルクt0が変化するため、この必要トルクt0が大きくなるほど目標速度と速度検出手段により検出される実際の速度v1との速度偏差Δvが大きくなる傾向があるものの、前記実施形態では当該速度偏差Δvが大きくなるのを阻止することができる。
具体的に、前記実施形態では、必要トルクt0が大きい程大きな補正値b0を算出してこの補正値b0を既に設定された目標速度v0から減算するようにしているので、この新たな目標速度(v0−b0)と速度センサ27により検出された実際の速度v1との速度偏差Δvを小さくすることができる。
したがって、前記実施形態によれば、必要トルクt0が大きい程速度偏差Δvを小さく
することができるので、ショックの発生を抑制することができる。
前記実施形態のように、操作レバー25の操作量a0が大きい程小さな補正量b0を算出するようにした構成とすることにより、操作レバー25の操作量a0が大きくなるに従い、補正後の目標速度が小さくなり過ぎるのを抑制することができるので、オペレータに与える違和感を緩和することができる。
前記実施形態のように、前回設定された目標トルクを今回使用する必要トルクt0として利用する構成とすることにより、実際に上部旋回体3の必要トルクt0を算出する場合と比較して処理の簡素化を図ることができる。
つまり、上部旋回体3の必要トルクt0の変化は、全て旋回用電動機18の負荷トルク(目標トルク)に反映されるため、当該負荷トルクの増減に応じて補正値b0を算出して目標トルクを算出することにより、必要トルクt0の変化に見合った目標トルクを算出することができる。
前記実施形態のように、第一目標トルクt1及び第二目標トルクt2のうち、第一目標トルクt1と同じ方向のトルクであって、絶対値の大きなトルクを目標トルクに設定する目標トルク設定部32を備えた構成とすることにより、傾斜地で上り側に向かって旋回開始する場合や、強風下で風上側に向かって旋回開始する場合に、上部旋回体3がトルク不足によって逆方向に旋回する「逆行」の発生を確実に防止することができる。
さらに、傾斜地で旋回停止する場合も、常に旋回用電動機18のトルクが重力と吊り合う大きさとなるため、制動トルクが重力に負けて上部旋回体3が下り側に逆行するのを防止することができる。
本発明の実施形態に係るショベルの全体構成を示す側面図を示している。 図1のショベルの駆動・制御系の構成を示すブロック図である。 図2のコントローラに記憶されたマップであって、操作レバーの操作量と目標速度とを対応付けたものである。 図2のコントローラの電気的構成を示すブロック図である。 図2のコントローラにより実行される処理を示すフローチャートである。 ショベルのバケットを地面に押し当てた状態で、操作レバーを操作した場合における、当該操作レバーの操作状態、旋回トルク及び旋回速度をそれぞれ示したものである。 必要トルクt0を加味しない場合における図6相当図である。 図6の状態における、操作レバーの操作量と旋回トルクとの関係を示すグラフである。 上部旋回体に生じている必要トルクが比較的小さい場合おける操作レバーの操作量、旋回速度及び旋回トルクをそれぞれ示したものである。 必要トルクt0を加味しない場合における図9相当図である。 操作レバーの操作量と電動機の目標速度との関係を示すグラフである。 従来の技術に係る制御を示すグラフであり、(a)は速度比例制御のトルク推移とその場保持のためのトルクの推移とを示したものであり、(b)は速度比例制御からトルク制御への切り換わりの状態を示すものである。 本願発明に係る制御を示すグラフであり、(a)は速度比例制御のトルク推移とその場保持のためのトルクの推移とを示したものであり、(b)は速度比例制御からトルク制御への切り換わりの状態を示すものである。
符号の説明
1 ショベル(作業機械)
2 下部走行体
3 上部旋回体
4 作業アタッチメント
18 旋回用電動機
23 インバータ(モーメント特定手段)
25 操作レバー(操作手段)
26 コントローラ(制御手段)
27 速度センサ(速度検出手段)
28 目標速度設定部
29 補正量算出部
30 第一トルク演算部
31 第二トルク演算部
32 目標トルク設定部

Claims (5)

  1. 本体と、この本体に旋回可能に搭載された旋回体と、この旋回体に起伏可能に設けられた作業アタッチメントとを有する作業機械に設けられた旋回制御装置であって、
    前記旋回体を旋回駆動するための電動機と、
    この電動機に対する駆動指示の入力操作を受ける操作手段と、
    この操作手段の操作量を検出可能な操作量検出手段と、
    前記電動機の回転速度を検出可能な速度検出手段と、
    前記操作量検出手段により検出された操作量に対応する目標速度で前記電動機を駆動させるための第一目標トルクを設定するとともに、前記速度検出手段により検出された現実の速度に基づいて前記旋回体をその場で保持させるための第二目標トルクを設定し、これら第一目標トルク、第二目標トルクのうち、前記第一目標トルクと同じ方向のトルクであって絶対値の大きなトルクに応じて前記電動機を作動させる制御手段とを備えていることを特徴とする作業機械の旋回制御装置。
  2. 前記制御手段は、前記操作量検出手段により検出された操作量に基づいて前記目標速度を設定する目標速度設定手段と、前記目標速度と前記速度検出手段により検出された現実の速度との速度偏差に基づいて前記第一目標トルクを算出する第一トルク演算手段と、前記第一目標トルク、第二目標トルクのうち、前記第一目標トルクと同じ方向のトルクであって絶対値の大きなトルクを次の目標トルクとして設定する目標トルク設定手段とを備えていることを特徴とする請求項1に記載の作業機械の旋回制御装置。
  3. 前記制御手段は、前記現実の速度を零にするために前記電動機に与えるべきトルクを前記第二目標トルクとして算出する第二トルク演算手段をさらに備えていることを特徴とする請求項2に記載の作業機械の旋回制御装置。
  4. 前記第一トルク演算手段及び第二トルク演算手段は、それぞれ比例項と積分項とを有する数式に従って第一目標トルク及び第二目標トルクを算出するようになっており、前記制御手段は、前記比例項及び積分項に乗されるゲインの大小を変更可能なゲイン変更手段をさらに備えていることを特徴とする請求項3に記載の作業機械の旋回制御装置。
  5. 機体と、この機体に旋回可能に搭載された旋回体と、請求項1〜4のいずれか1項に記載の旋回制御装置とを備えた作業機械。
JP2007221183A 2007-02-21 2007-08-28 旋回制御装置及びこれを備えた作業機械 Active JP4793352B2 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP2007221183A JP4793352B2 (ja) 2007-02-21 2007-08-28 旋回制御装置及びこれを備えた作業機械
US12/034,331 US8190334B2 (en) 2007-02-21 2008-02-20 Rotation control device and working machine therewith
EP08151686.6A EP1961869B1 (en) 2007-02-21 2008-02-20 Rotation control device and working machine therewith
EP10174647.7A EP2275606B1 (en) 2007-02-21 2008-02-20 Rotation control device and working machine therewith
CN200810080597XA CN101250888B (zh) 2007-02-21 2008-02-20 旋转控制装置及设有该装置的作业机械

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2007041381 2007-02-21
JP2007041381 2007-02-21
JP2007221183A JP4793352B2 (ja) 2007-02-21 2007-08-28 旋回制御装置及びこれを備えた作業機械

Publications (2)

Publication Number Publication Date
JP2008231903A JP2008231903A (ja) 2008-10-02
JP4793352B2 true JP4793352B2 (ja) 2011-10-12

Family

ID=39905033

Family Applications (2)

Application Number Title Priority Date Filing Date
JP2007221182A Expired - Fee Related JP4946733B2 (ja) 2007-02-21 2007-08-28 旋回制御装置及びこれを備えた作業機械
JP2007221183A Active JP4793352B2 (ja) 2007-02-21 2007-08-28 旋回制御装置及びこれを備えた作業機械

Family Applications Before (1)

Application Number Title Priority Date Filing Date
JP2007221182A Expired - Fee Related JP4946733B2 (ja) 2007-02-21 2007-08-28 旋回制御装置及びこれを備えた作業機械

Country Status (2)

Country Link
JP (2) JP4946733B2 (ja)
CN (1) CN101250888B (ja)

Families Citing this family (26)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4824004B2 (ja) * 2007-11-30 2011-11-24 住友建機株式会社 旋回駆動制御装置及びこれを含む建設機械
JP5298861B2 (ja) * 2009-01-06 2013-09-25 コベルコ建機株式会社 作業機械の旋回制御装置
KR101112135B1 (ko) * 2009-07-28 2012-02-22 볼보 컨스트럭션 이큅먼트 에이비 전기모터를 이용한 건설기계의 선회 제어시스템 및 방법
CN102051895B (zh) * 2009-11-05 2012-08-08 北汽福田汽车股份有限公司 一种挖掘机行走控制的装置和方法
JP5448186B2 (ja) * 2010-06-23 2014-03-19 キャタピラー エス エー アール エル 作業機械の電動機トルク制御装置
JP5395818B2 (ja) * 2011-01-21 2014-01-22 日立建機株式会社 作業機械の旋回制御装置
CA2968400A1 (en) * 2011-04-29 2012-11-01 Harnischfeger Technologies, Inc. Controlling a digging operation of an industrial machine
JP6119154B2 (ja) * 2012-09-19 2017-04-26 コベルコ建機株式会社 作業機械の旋回制御装置
JP2014084195A (ja) * 2012-10-23 2014-05-12 Tadano Ltd 作業機械用電動アクチュエータの制御装置
JP6078300B2 (ja) * 2012-11-07 2017-02-08 カルソニックカンセイ株式会社 電動コンプレッサの制御装置
CN103043546B (zh) * 2012-12-26 2014-12-17 苏州汇川技术有限公司 塔式起重机回转控制***及方法
CN103061371B (zh) * 2012-12-28 2014-12-10 上海华兴数字科技有限公司 一种工程机械控制方法、***及挖掘机
US10024341B2 (en) 2013-01-30 2018-07-17 Parker-Hannifin Corporation Hydraulic hybrid swing drive system for excavators
EP3040484B1 (en) * 2013-08-30 2021-11-03 Hitachi Construction Machinery Co., Ltd Working machine
JP6347977B2 (ja) * 2014-03-31 2018-06-27 住友重機械工業株式会社 ショベル
WO2016088904A1 (ja) * 2016-01-20 2016-06-09 株式会社小松製作所 建設機械、ハイブリッド油圧ショベル、および電動発電機の出力トルク制御方法
CN105858482B (zh) * 2016-05-13 2017-08-04 北汽福田汽车股份有限公司 用于起重机的控制方法、控制装置和控制***
JP6422169B2 (ja) * 2016-05-18 2018-11-14 三菱ロジスネクスト株式会社 走行制御装置および産業車両
JP6662835B2 (ja) * 2017-10-18 2020-03-11 ファナック株式会社 制御装置
US10519626B2 (en) * 2017-11-16 2019-12-31 Caterpillar Inc. System and method for controlling machine
CN110221626B (zh) * 2019-06-06 2022-03-25 睿魔智能科技(深圳)有限公司 一种跟拍控制方法、装置、计算机设备及存储介质
JP7179688B2 (ja) * 2019-06-19 2022-11-29 日立建機株式会社 作業機械
WO2023053502A1 (ja) * 2021-09-30 2023-04-06 日立建機株式会社 作業機械
JP2023068411A (ja) * 2021-11-02 2023-05-17 コベルコ建機株式会社 操作量算出システム
CN113934255B (zh) * 2021-12-20 2022-03-08 广州朗国电子科技股份有限公司 旋转控制装置、控制方法和音响***
CN116969331B (zh) * 2023-09-21 2023-12-12 华侨大学 一种五次多项式平滑自定义轨迹精度并联起重机

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4002369B2 (ja) * 1999-06-29 2007-10-31 株式会社神戸製鋼所 旋回式作業機械の旋回制御装置
KR100674516B1 (ko) * 2002-05-09 2007-01-26 코벨코 겐키 가부시키가이샤 작업 기계의 선회 제어 장치
GB2431018B (en) * 2004-05-13 2008-06-04 Komatsu Mfg Co Ltd Rotation control device, rotation control method, and construction machine
EP1813728A4 (en) * 2004-11-17 2014-09-17 Komatsu Mfg Co Ltd SWIVEL CONTROL DEVICE AND CONSTRUCTION MACHINE
EP1813729B1 (en) * 2004-11-17 2017-04-19 Komatsu Ltd. Rotation control device and construction machine

Also Published As

Publication number Publication date
JP4946733B2 (ja) 2012-06-06
CN101250888B (zh) 2012-08-15
CN101250888A (zh) 2008-08-27
JP2008231903A (ja) 2008-10-02
JP2008231902A (ja) 2008-10-02

Similar Documents

Publication Publication Date Title
JP4793352B2 (ja) 旋回制御装置及びこれを備えた作業機械
EP1961869B1 (en) Rotation control device and working machine therewith
JP4167289B2 (ja) 旋回制御装置および建設機械
JP4851802B2 (ja) 建設機械の旋回駆動装置
JP6899818B2 (ja) ショベル
KR101671876B1 (ko) 선회제어장치 및 방법
JP5298861B2 (ja) 作業機械の旋回制御装置
WO2014013877A1 (ja) 作業機械
JPWO2017104238A1 (ja) ショベルおよびその制御方法
WO2019065123A1 (ja) ホイールローダ
JP2007100327A (ja) 建設機械の駆動制御装置
JP5970625B1 (ja) 建設機械、ハイブリッド油圧ショベル、および電動発電機の出力トルク制御方法
JP4294086B2 (ja) 電動機の制御装置
JP6968308B2 (ja) 荷役作業車両
JP2010095906A (ja) 建設機械および旋回制御装置
JP2014224453A (ja) 交流電動機駆動制御装置
JP2004137702A (ja) 作業機械のアクチュエータ制御装置
WO2019064527A1 (ja) ホイールローダ
JP4557187B2 (ja) 電動機の制御装置
JP6952659B2 (ja) 建設機械
JP4990212B2 (ja) 建設機械の電気・油圧駆動装置
JP2011001736A (ja) 建設機械の旋回制御装置
JP6708969B2 (ja) 旋回制御装置
JP4713552B2 (ja) 建設機械の走行制御装置
JP4609736B2 (ja) 電動機の制御装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20100528

TRDD Decision of grant or rejection written
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20110622

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20110628

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20110711

R150 Certificate of patent or registration of utility model

Ref document number: 4793352

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140805

Year of fee payment: 3