JP2017008501A - 作業機械 - Google Patents

作業機械 Download PDF

Info

Publication number
JP2017008501A
JP2017008501A JP2015122306A JP2015122306A JP2017008501A JP 2017008501 A JP2017008501 A JP 2017008501A JP 2015122306 A JP2015122306 A JP 2015122306A JP 2015122306 A JP2015122306 A JP 2015122306A JP 2017008501 A JP2017008501 A JP 2017008501A
Authority
JP
Japan
Prior art keywords
pressure
valve
unit
stop
pilot pressure
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
JP2015122306A
Other languages
English (en)
Other versions
JP6619163B2 (ja
JP2017008501A5 (ja
Inventor
麻里子 水落
Mariko Mizuochi
麻里子 水落
啓範 石井
Keihan Ishii
啓範 石井
和吉 花川
Wakichi Hanakawa
和吉 花川
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.)
Hitachi Construction Machinery Co Ltd
Original Assignee
Hitachi 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 Hitachi Construction Machinery Co Ltd filed Critical Hitachi Construction Machinery Co Ltd
Priority to JP2015122306A priority Critical patent/JP6619163B2/ja
Priority to CN201610101989.4A priority patent/CN106256966B/zh
Priority to KR1020160021711A priority patent/KR101814657B1/ko
Priority to US15/183,132 priority patent/US10024032B2/en
Priority to EP16174832.2A priority patent/EP3106572B1/en
Publication of JP2017008501A publication Critical patent/JP2017008501A/ja
Publication of JP2017008501A5 publication Critical patent/JP2017008501A5/ja
Application granted granted Critical
Publication of JP6619163B2 publication Critical patent/JP6619163B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • 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/22Hydraulic or pneumatic drives
    • E02F9/2221Control of flow rate; Load sensing arrangements
    • E02F9/2225Control of flow rate; Load sensing arrangements using pressure-compensating valves
    • E02F9/2228Control of flow rate; Load sensing arrangements using pressure-compensating valves including an electronic controller
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/30Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
    • E02F3/32Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
    • 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/22Hydraulic or pneumatic drives
    • 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/22Hydraulic or pneumatic drives
    • E02F9/2203Arrangements for controlling the attitude of actuators, e.g. speed, floating function
    • 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/22Hydraulic or pneumatic drives
    • E02F9/2203Arrangements for controlling the attitude of actuators, e.g. speed, floating function
    • E02F9/2207Arrangements for controlling the attitude of actuators, e.g. speed, floating function for reducing or compensating oscillations
    • 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/22Hydraulic or pneumatic drives
    • E02F9/2253Controlling the travelling speed of vehicles, e.g. adjusting travelling speed according to implement loads, control of hydrostatic transmission
    • 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/22Hydraulic or pneumatic drives
    • E02F9/2264Arrangements or adaptations of elements for hydraulic drives
    • E02F9/2267Valves or distributors
    • 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/22Hydraulic or pneumatic drives
    • E02F9/2264Arrangements or adaptations of elements for hydraulic drives
    • E02F9/2271Actuators and supports therefor and protection 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/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2285Pilot-operated 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/26Indicating devices
    • E02F9/267Diagnosing or detecting failure of vehicles
    • E02F9/268Diagnosing or detecting failure of vehicles with failure correction follow-up actions
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B11/00Servomotor systems without provision for follow-up action; Circuits therefor
    • F15B11/16Servomotor systems without provision for follow-up action; Circuits therefor with two or more servomotors
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B13/00Details of servomotor systems ; Valves for servomotor systems
    • F15B13/02Fluid distribution or supply devices characterised by their adaptation to the control of servomotors
    • F15B13/06Fluid distribution or supply devices characterised by their adaptation to the control of servomotors for use with two or more servomotors
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/96Dredgers; Soil-shifting machines mechanically-driven with arrangements for alternate or simultaneous use of different digging elements
    • E02F3/963Arrangements on backhoes for alternate use of different tools
    • E02F3/964Arrangements on backhoes for alternate use of different tools of several tools mounted on one machine
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00Circuits for servomotor systems
    • F15B2211/50Pressure control
    • F15B2211/575Pilot pressure control

Landscapes

  • Engineering & Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Civil Engineering (AREA)
  • Structural Engineering (AREA)
  • Mining & Mineral Resources (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Fluid Mechanics (AREA)
  • Operation Control Of Excavators (AREA)
  • Architecture (AREA)
  • Fluid-Pressure Circuits (AREA)
  • Chemical & Material Sciences (AREA)
  • Chemical Kinetics & Catalysis (AREA)
  • Electrochemistry (AREA)

Abstract

【課題】作業機械を安定に保つために必要な動作制限を従来の操作性を維持可能な構成で実現し、操作性および安定性の高い作業機械を提供する。
【解決手段】作業機械の安定状態に応じて駆動アクチュエータを緩やかに停止させる緩停止指令および上限動作速度を制限する動作速度制限指令を演算・出力する安定化制御演算部60aと、操作レバーの停止操作時に駆動アクチュエータを緩やかに停止させるようにパイロット圧を補正する停止特性変更部210と、駆動アクチュエータの動作速度を制限するようにパイロット圧を補正する動作速度制限部240とを有し、安定化制御演算部60aから緩停止指令および動作速度制限指令が入力された場合は比例減圧弁から出力されるパイロット圧を補正し、緩停止指令および動作速度制限指令が入力されない場合は比例減圧弁から出力されるパイロット圧を補正することなく流量制御弁に供給する。
【選択図】図3

Description

本発明は、構造物解体工事、廃棄物処理、スクラップ処理、道路工事、建設工事、土木工事等に使用される作業機械に関する。
構造物解体工事、廃棄物処理、スクラップ処理、道路工事、建設工事、土木工事等に使用される作業機械として、動力系により走行する走行体の上部に旋回体を旋回自在に取り付けると共に、旋回体に多関節型の作業フロントを上下方向に揺動自在に取り付け、作業フロントを構成する各フロント部材をアクチュエータにて駆動する作業機械が知られている。このような作業機械の一例として、油圧ショベルをベースとし、一端が旋回体に揺動自在に連結されたブームと、一端がブームの先端に揺動自在に連結されたアームと、アームの先端に装着されたグラップル、バケット、ブレーカ、クラッシャ等のアタッチメントを備え、所望の作業を行えるようにした作業機械がある。
この種の作業機械は、作業フロントを構成するブーム、アームおよびアタッチメントを旋回体の外方に突き出した状態で種々姿勢を変えながら作業を行う。このため、過度の作業負荷をかける、過負荷かつフロントを伸ばした状態で急動作を行う等の無理な操作を行った場合に作業機械がバランスを崩すことがある。したがって、この種の作業機械については、従来種々の転倒防止技術が提案されている。
例えば、特許文献1には、作業機械のブームおよびアームにそれぞれ角度センサを設け、これら各角度センサの検出信号を制御装置に入力し、制御装置が、前記検出信号に基づいて作業機械全体の重心位置と、走行体の接地面における安定支点の支持力を演算し、その演算結果に基づく安定支点における支持力値を表示装置に表示すると共に、後方安定支点における支持力が安全作業確保上の限界値以下になったときには警報を発するようにした技術が開示されている。
一方、前述の解体作業機械のような作業機械は、大質量の走行体、旋回体および作業フロントを駆動することにより作業を行うので、何らかの理由により操作者が動作中の走行体、旋回体又は作業フロントの駆動を急停止させる操作を行った場合、作業機械に大きな慣性力が作用し、安定性に大きな影響を与える。特に、搭載された警報装置から転倒の可能性を通知する警報が発せられた場合に、操作者が慌てて動作中の走行体、旋回体又は作業フロントの駆動を停止させる操作を行うと、転倒方向に大きな慣性力が重畳されて、却って転倒の可能性が高まる虞がある。
このような課題に対しては、特許文献2において、作業フロントを含む本体および走行体の各可動部の位置情報と急停止モデルとを用いて、操作レバーが操作状態から瞬時に停止指令状態に戻された場合の作業機械が完全に停止に至るまでの安定性変化を予測し、停止に至るまでのいずれの時刻においても不安定にならないように駆動アクチュエータの動作制限を行う制御技術が開示されている。
特許第2871105号公報 国際公開第2012/169531号
作業機械に対して特許文献2に示される技術を適用することによって、無理な操作や操作ミスにより急に動作を停止させる場合であっても、作業機械が転倒することを未然に回避し、安定に作業を継続させることができる。特許文献2に示される技術は、制御演算結果に基づいて、作業機械の駆動アクチュエータの動作を制限する技術である。
一般に、作業機械の駆動アクチュエータは、駆動アクチュエータへの圧油の供給を制御するパイロット式流量制御弁と操作レバーの操作に基づいて流量制御弁にパイロット圧油を出力する比例減圧弁とを備えて構成される油圧パイロット式駆動油圧回路によって駆動制御される。
このような作業機械に特許文献2に示される技術を適用し、駆動アクチュエータに対して動作制限を行うためには、制御演算結果に応じてアクチュエータへの圧油の供給を変更する制御手段を駆動油圧回路に組み込む必要がある。しかしながら、従来例では、油圧パイロット式駆動油圧回路を備えた作業機械において、動作制限を実現するための構成が示されていない。また、駆動油圧回路に制御手段を組み込む際に、駆動油圧回路の構成を大幅に変更すると、応答性等が変化し、従来の操作性が損なわれる恐れがある。
本発明は、上記の課題を解決するためになされたものであり、作業機械を安定に保つために必要な動作制限を従来の操作性を維持可能な構成で実現し、操作性および安定性の高い作業機械を提供することを目的とする。
上記課題を解決するために、例えば特許請求の範囲に記載の構成を採用する。
本発明は、上記課題を解決する手段を複数含んでいるが、その一例を挙げるならば、作業機械本体と、この作業機械本体に対して上下方向に揺動自在に取り付けられ複数の可動部を有する作業フロントと、この作業フロントの各可動部を駆動する駆動アクチュエータと、この駆動アクチュエータの駆動を制御する制御演算を行う演算装置と、前記駆動アクチュエータへの圧油の供給を制御する流量制御弁および操作レバーの操作に基づいて前記流量制御弁に供給するパイロット圧油を出力する比例減圧弁を有するアクチュエータ駆動油圧回路とを備えた作業機械において、前記演算装置は、作業機械の速度を推定する速度推定部と、前記速度推定部によって推定された速度と作業機械の姿勢に基づき、作業機械が急停止すると仮定した場合の作業機械の挙動を予測する急停止時挙動予測部と、前記急停止時挙動予測部によって予測された挙動に基づき前記作業機械の安定性を判定する安定性判定部と、前記安定性判定部の判定結果に基づき前記駆動アクチュエータの減速度を制限して前記駆動アクチュエータを緩やかに停止させる緩停止指令および前記駆動アクチュエータの上限動作速度を制限する動作速度制限指令を演算し、出力する動作制限決定部とを有し、前記アクチュエータ駆動油圧回路は、前記動作制限決定部からの前記緩停止指令および前記動作速度制限指令に応じて前記比例減圧弁から出力されるパイロット圧を補正するパイロット圧補正部を有し、このパイロット圧補正部は、前記操作レバーの停止操作時に前記駆動アクチュエータを緩やかに停止させるようにパイロット圧を補正する停止特性変更部と、前記駆動アクチュエータの動作速度を制限するようにパイロット圧を補正する動作速度制限部とから構成され、前記停止特性変更部および前記動作速度制限部は、前記動作制限決定部からの前記緩停止指令および前記動作速度制限指令によってそれぞれ駆動され、前記動作制限決定部から前記緩停止指令および前記動作速度制限指令が入力された場合は前記比例減圧弁から出力されるパイロット圧を補正し、前記動作制限決定部から前記緩停止指令および前記動作速度制限指令が入力されない場合には、前記比例減圧弁から出力されるパイロット圧を補正することなく前記流量制御弁に供給することを特徴とする。
本発明によれば、作業機械の安定状態に応じた動作制限が従来のアクチュエータ駆動回路を生かした構成で行われ、操作性を損なうことなく動作制限を行うことができ、作業機械を安定に保つことができる。
第1の実施形態に係る作業機械の側面図である。 一般的な作業機械の駆動アクチュエータの駆動油圧回路の概念図である。 一般的な作業機械のブームシリンダの駆動油圧回路の概略構成図である。 第1の実施形態に係る安定化制御装置の概略構成図である。 第1の実施形態に係るパイロット圧補正部における緩停止を行うためのパイロット圧補正例を示す図である。 第1の実施形態に係るパイロット圧補正部における動作速度制限を行うためのパイロット圧補正例を示す図である。 第1の実施形態に係る作業機械の駆動アクチュエータの駆動油圧回路の概念図である。 第1の実施形態に係る作業機械のブームシリンダの駆動油圧回路の概略構成図である。 第1の実施形態に係る安定性評価方法の説明図である。 第1の実施形態に係る動作制限決定部における演算手順を示すフローチャートである。 第1の実施形態に係るパイロット圧補正部への駆動指令のうち、指令信号と電磁弁設定圧との関係の一例を示す図である。 第1の実施形態に係るパイロット圧補正部における緩停止及び動作速度制限を行うためのパイロット圧補正の例を示す図である。 第1の実施形態に係る緩停止用電磁比例弁への駆動指令値と時間との関係の一例を示す図である。 第1の実施形態に係る速度制限用電磁比例弁への駆動指令値と時間との関係の一例を示す図である。 第1の実施形態に係るパイロット圧補正部の変更例の概略構成図である。 第1の実施形態に係るパイロット圧補正部の変更例の概略構成図である。 第2の実施形態に係るパイロット圧補正部の概略構成図である。 第3の実施形態に係るパイロット圧補正部の概略構成図である。
以下に本発明の作業機械の実施形態を、図面を用いて説明する。
<第1の実施形態>
本発明の作業機械の第1の実施形態を、図1乃至図9Bを用いて説明する。
<対象装置>
図1に示すように、本実施形態に係る作業機械1は、走行体2と、走行体2の上部に旋回可能に取り付けられた旋回体3と、一端が旋回体3に連結された多関節型のリンク機構よりなる作業フロント6とを備えている。
旋回体3は旋回モータ7によって中心軸3cを中心に旋回駆動される。旋回体3上には運転室4およびカウンタウエイト8が設置されている。また、この旋回体3上の所要の部分には、動力系を構成するエンジン5と、駆動アクチュエータ(後述)の駆動油圧回路100等から構成され、作業機械1の起動停止および動作全般を制御する運転制御装置9が備えられている。
なお、図中の符号29は地表面を示している。
作業フロント6は、一端が旋回体3に連結されたブーム10(可動部)と、一端がブーム10の他端に連結されたアーム12(可動部)と、一端がアーム12の他端に連結されたアタッチメント23(可動部)とを有しており、これらの各部材は、それぞれ上下方向に回動するように構成されている。
ブームシリンダ11は、ブーム10を支点40の回りに回動する駆動アクチュエータであり、旋回体3とブーム10とに連結されている。アームシリンダ13は、アーム12を支点41の回りに回動する駆動アクチュエータであり、ブーム10とアーム12とに連結されている。アタッチメントシリンダ15はアタッチメント23を支点42の回りに回動する駆動アクチュエータであり、リンク16を介してアタッチメント23と連結され、リンク17を介してアーム12に連結されている。アタッチメント23は、マグネット、グラップル、カッタ、ブレーカ、バケット等の図示しない作業具に任意に交換可能である。旋回モータ7は、旋回体3を駆動する駆動アクチュエータである。
運転室4内には、オペレータが各駆動アクチュエータに対する動きの指示を入力するための複数の操作レバー50が備えられている。
<駆動アクチュエータの駆動油圧回路>
図2Aに油圧パイロット式操作装置を有する一般的な作業機械における駆動アクチュエータの駆動油圧回路の概念図を示す。
図2Aにおいて、作業機械1の各駆動アクチュエータ7,11,13,15はメインポンプ101から供給される圧油によって駆動される。駆動油圧回路100Aは、各駆動アクチュエータ7,11,13,15に圧油を供給するための回路であり、主に、エンジン5によって駆動されるメインポンプ101およびパイロットポンプ102と、メインポンプ101と接続され、駆動アクチュエータへの供給流量を制御するパイロット式流量制御弁群110と、パイロットポンプ102と接続され、操作レバー50の操作に応じて流量制御弁群110に供給するパイロット圧油を生成する比例減圧弁群120とから構成される。
流量制御弁群110は、ブーム流量制御弁111、アーム流量制御弁113、アタッチメント流量制御弁115、旋回流量制御弁117から構成される。比例減圧弁群120は、ブーム伸長比例減圧弁121、ブーム縮小比例減圧弁122、アーム伸長比例減圧弁123、アーム縮小比例減圧弁124、アタッチメント伸長比例減圧弁125、アタッチメント縮小比例減圧弁126、右旋回比例減圧弁127、左旋回比例減圧弁128から構成される。
なお、駆動アクチュエータの駆動方法はいずれの駆動アクチュエータでも同様であるため、以下では、ブームシリンダ11を例にとって説明する。
図2Bに油圧パイロット式操作装置を有する一般的な作業機械におけるブームシリンダ11の駆動油圧回路100Aの概略構成図を示す。
図2Bにおいて、ブーム比例減圧弁は、ブーム伸長比例減圧弁121と、ブーム縮小比例減圧弁122とから構成される。これらの比例減圧弁121,122は、ブーム操作レバー50bを伸長側あるいは縮小側に操作することにより駆動され、パイロットポンプ102の吐出する圧油からブーム操作レバー50bの操作量に対応する圧力のパイロット圧油を生成する。
ブーム伸長比例減圧弁121は、第一ポート121a、第二ポート121b、および第三ポート121cを備えており、第一ポート121aは作動油タンク103と、第二ポート121bはパイロットポンプ102と、第三ポート121cは後述するブーム流量制御弁111のブーム伸長側パイロットポート111eと接続される。ブーム操作レバー50bを伸長側に操作していない場合には、第一ポート121aと第三ポート121cとを連通する弁路が全開、第二ポート121bが全閉となり、パイロットポンプ102からの圧油は第三ポート121cへ供給されない。ブーム操作レバー50bが伸長側に操作されると、その操作によって、第二ポート121bと第三ポート121cとを連通する弁路が開くように駆動され、パイロットポンプ102から第三ポート121cへパイロット圧油が供給され、レバー操作量に応じた圧力の圧油が第三ポート121cから出力される。ブーム操作レバー50bを操作状態から非操作状態に戻す方向に操作すると、ブーム伸長比例減圧弁121は、第二ポート121bと第三ポート121cとを連通する弁路を閉じ、第一ポート121aと第三ポート121cとを連通する弁路を開く方向に駆動され、非操作状態まで戻されると、第一ポート121aと第三ポート121cとを連通する弁路が全開となる。この時、第三ポート121cに接続されるパイロット油路の圧油は、第一ポート121aと第三ポート121cとを連通する弁路を流通して作動油タンク103に排出される。
ブーム縮小比例減圧弁122はブーム伸長比例減圧弁121と同様の構成を有している。ブーム操作レバー50bが縮小側に操作された場合には、ブーム伸長比例減圧弁121の代わりにブーム縮小比例減圧弁122が駆動され、レバー操作量に応じた圧力の圧油がブーム縮小比例減圧弁122の第三ポート122cから出力される。また、ブーム操作レバー50bを縮小側に操作した状態から非操作状態に戻す方向に操作すると、ブーム縮小比例減圧弁122の第三ポート122cに接続されるパイロット油路の圧油は、第一ポート122aと第三ポート122cとを連通する弁路を流通して作動油タンク103に排出される。
ブーム流量制御弁111は、ブーム伸長側パイロットポート111eとブーム縮小側パイロットポート111sを有するパイロット式の3位置切換弁である。ブーム伸長側パイロットポート111eには、ブーム伸長比例減圧弁121がブーム伸長側パイロット油路を介して接続され、ブーム縮小側パイロットポート111sには、ブーム縮小比例減圧弁122がブーム縮小側パイロット油路を介して接続される。また、ブーム流量制御弁111のアクチュエータ側ポート111a,111bは、それぞれブーム伸長側メイン油路およびブーム縮小側メイン油路を介してブームシリンダ11のボトム側油室11bおよびロッド側油室11rに接続される。ブーム流量制御弁111のポンプポート111pはメインポンプ101と、タンクポート111tは作動油タンク103とそれぞれ接続されている。
ブーム流量制御弁111のブーム伸長側パイロットポート111eとブーム縮小側パイロットポート111sとのいずれにもパイロット圧油が供給されていない場合には、ブーム流量制御弁111は中立位置となり、ブームシリンダ11への圧油の供給およびブームシリンダ11からの圧油の排出は行われない。ブーム操作レバー50bが伸長側に操作され、ブーム伸長側パイロットポート111eにパイロット圧油が供給されると、ブーム流量制御弁111は伸長駆動位置に切り換わり、メインポンプ101からの圧油がブームシリンダ11のボトム側油室11bに供給される。これにより、ブームシリンダ11は伸長駆動される。一方、ブーム操作レバー50bが縮小側に操作された場合には、ブーム縮小側パイロットポート111sにパイロット圧油が供給され、ブーム流量制御弁111が縮小駆動位置に切り換わり、メインポンプ101からの圧油がブームシリンダ11のロッド側油室11rに供給される。これにより、ブームシリンダ11は縮小駆動される。この時、ブーム流量制御弁111の開口面積は、各パイロットポート111e,111sに供給されるパイロット圧油の圧力によって決定され、ブームシリンダ11はパイロット圧油の圧力に応じた速度で伸縮駆動される。
≪安定化制御≫
本実施形態に係る作業機械1には、作業中の不安定化を防ぐ安定化制御装置190が搭載されている。作業機械1では、オペレータが操作レバー50を操作することにより、種々の作業が行われるが、作業フロント6を伸ばした姿勢で作業を行う場合やアタッチメント23に加わる負荷が大きい場合には安定性が低下する。また、急操作を行った場合には、急激な速度変化に伴って大きな慣性力が作用し、その影響により、作業機械1の安定性が大きく変化する。特に、操作レバー50を操作状態から瞬時に停止指令状態に戻すような急停止操作時には、転倒方向に大きな慣性力が働き、作業機械1が不安定になりやすい。
本実施形態の安定化制御装置190は、無理な操作や誤った操作を行った場合であっても作業機械1が不安定にならないよう、安定性評価に基づいて駆動アクチュエータの動作を制限する装置である。また、本実施形態の安定化制御装置190は、急停止操作により安定性が大幅に低下することを考慮し、作業機械1を安定に保つための動作制限として、緩停止と動作速度制限を行う。
ここで、緩停止とは停止操作時の可動部の減速加速度を制限し、可動部を緩やかに停止させる作用であり、動作速度制限とは駆動アクチュエータの最大速度を制限する作用である。緩停止を導入することにより、急停止操作時に発生する慣性力を抑制することができ、急停止に伴って発生する大きな慣性力によって作業機械1が不安定になることを防ぐことができる。一方、緩停止を行うと、制動距離が増大するため、あらかじめ許容制動距離を定め、許容制動距離内で停止できるように停止特性を設定する必要がある。そこで、本実施形態の安定化制御装置190は、あらかじめ定められた許容制動距離の範囲内で必要に応じて緩停止を行い、また、いかなる動作状態においても許容制動距離内で安定に作業できるように動作速度を制限する。
安定化制御装置190は、作業機械1に備えられた全ての駆動アクチュエータに対して動作制限を行うように構成されている。しかし、以下では、作業機械1の安定性に特に大きな影響を与えるブームシリンダ11とアームシリンダ13に対してのみ、動作制限を適用するように構成した場合を例にとって説明する。
図3に本実施形態の安定化制御装置190の概略構成図を示す。
図3において、安定化制御装置190は、主に、状態量検出部30と、演算装置60と、パイロット圧補正部200とから構成される。
状態量検出部30は、作業機械1の状態量を検出するために作業機械1の各所に取り付けられたセンサである。
演算装置60は、図示しないCPU(Central Processng Unt)、記憶装置等から構成され、状態量検出部30の検出信号に基づいて、安定化制御演算を行い、作業機械1を安定に保つために必要なブームシリンダ11およびアームシリンダ13の動作制限を算出し、パイロット圧補正部200への駆動指令を出力する。
パイロット圧補正部200は、オペレータからのレバー操作によって生成されるパイロット圧油の圧力を、演算装置60において算出された動作制限を満たすように補正する油圧装置であり、流量制御弁群110と比例減圧弁群120とを接続するパイロット油路に設けられている。
以下、各部の詳細を説明する。
<状態量検出部>
作業機械1の主要部分には、状態量検出部30として、機械の状態量を検出するセンサが備えられる。以下、本実施形態に係る作業機械1に備えられる状態量検出部30の詳細について、図1および図3を参照して説明する。
本実施形態の状態量検出部30は、作業機械1の姿勢を検出する姿勢検出部49と、各駆動アクチュエータに対するオペレータからの動作指令量を検出するレバー操作量検出部50aとから構成される。
姿勢検出部49は、作業機械1の姿勢を検出する機能ブロックであり、姿勢センサ3b、各角度センサ3s,40a,41a,42aから構成される。旋回体3には、作業機械1の傾きを検出するための姿勢センサ3bが設けられる。また、旋回体3の中心軸3c上には、走行体2と旋回体3の旋回角度を検出するための旋回角度センサ3sが設けられる。旋回体3とブーム10の支点40には、ブーム10の回動角度を計測するためのブーム角度センサ40aが設けられる。ブーム10とアーム12の支点41には、アーム12の回動角度を計測するためのアーム角度センサ41aが設けられる。アーム12とアタッチメント23の支点42には、アタッチメント角度センサ42aが設けられる。
レバー操作量検出部50aは、作業機械1の各駆動アクチュエータに対するオペレータからの動作指令量を検出する機能ブロックであり、操作レバー50の操作量を検出するレバー操作量センサが設けられる。前述の油圧パイロット式操作装置では、操作レバー50を操作すると比例減圧弁群120のうちの対応する比例減圧弁が駆動され、レバー操作量に応じた圧力のパイロット圧油が出力される。したがって、各比例減圧弁の出力する圧油の圧力を検出する圧力センサを設けることにより、オペレータからの動作指令量を検出することができる。
より具体的には、ブーム伸長比例減圧弁121の出力する圧油の圧力を検出するブーム伸長操作量センサ51と、ブーム縮小比例減圧弁122の出力する圧油の圧力を検出するブーム縮小操作量センサ52と、アーム伸長比例減圧弁123の出力する圧油の圧力を検出するアーム伸長操作量センサ53と、アーム縮小比例減圧弁の124出力する圧油の圧力を検出するアーム縮小操作量センサ54と、アタッチメント伸長比例減圧弁125の出力する圧油の圧力を検出するアタッチメント伸長操作量センサ55と、アタッチメント縮小比例減圧弁126の出力する圧油の圧力を検出するアタッチメント縮小操作量センサ56と、右旋回比例減圧弁127の出力する圧油の圧力を検出する右旋回操作量センサ57と、左旋回比例減圧弁128の出力する圧油の圧力を検出する左旋回操作量センサ58とが設けられる。
<パイロット圧補正部>
パイロット圧補正部200は、オペレータのレバー操作に応じて比例減圧弁群から出力されるパイロット圧油の圧力を、後述する演算装置60内の安定化制御演算部60aから指令される動作制限を満たす圧力に補正する機能ブロックである。本実施形態の安定化制御装置190では、安定化のための動作制限として、停止特性を変更して緩やかに停止させる緩停止と、動作速度に上限を設ける動作速度制限を行う。パイロット圧補正部200は、この2種類の動作制限を行うために、停止特性変更部210と動作速度制限部240とを備えている。
図5Aに、本実施形態の安定化制御装置190におけるパイロット圧補正部200を備えた駆動アクチュエータの駆動油圧回路の概念図を示す。
安定化制御演算に基づく動作制限をブームシリンダ11およびアームシリンダ13に対して適用する場合、作業機械1はパイロット圧補正部200として、図5Aに示すようにブーム伸長パイロット圧補正部201、ブーム縮小パイロット圧補正部202、アーム伸長パイロット圧補正部203、アーム縮小パイロット圧補正部204が設けられる。
ブーム伸長パイロット圧補正部201はブーム伸長停止特性変更部211とブーム伸長動作速度制限部241を、ブーム縮小パイロット圧補正部202はブーム縮小停止特性変更部212とブーム縮小動作速度制限部242を、アーム伸長パイロット圧補正部203はアーム伸長停止特性変更部213とアーム伸長動作速度制限部243を、アーム縮小パイロット圧補正部204はアーム縮小停止特性変更部214とアーム縮小動作速度制限部244をそれぞれ備えている。各パイロット圧補正部201,202,203,204の構成はいずれについても同様であるため、以下では、ブーム伸長パイロット圧油の補正を例にとり、図5Bを参照してブーム伸長パイロット圧補正部201の詳細を説明する。
前述のように、ブームシリンダ11の動作は、ブーム流量制御弁111の各パイロットポート111e,111sに供給されるパイロット圧油の圧力によって決定される。したがって、何らかの制御を導入し、制御演算結果に基づいてブームシリンダ11を伸長駆動するためには、ブーム流量制御弁111のブーム伸長側パイロットポート111eにパイロット圧油を供給するパイロット油路に、レバー操作に応じて比例減圧弁121から出力されるパイロット圧油の圧力を補正し、制御演算結果を満たす圧力の圧油を生成するパイロット圧補正部201を設ければ良い。以下では、レバー操作に応じて比例減圧弁121から出力されるパイロット圧油をレバー操作パイロット圧油、レバー操作パイロット圧油の圧力をレバー操作パイロット圧と呼び、パイロット圧補正部201によって補正されたパイロット圧油を補正パイロット圧油、補正パイロット圧油の圧力を補正パイロット圧と呼ぶ。
制御演算結果に基づく所望のパイロット圧を生成する方法としては、パイロットポンプ102とブーム流量制御弁111とを接続するパイロット油路に電気指令に基づいてパイロットポンプ102が吐出する圧油を減圧して出力する電磁比例弁を設ける構成が考えられる。電磁比例弁を制御演算結果に基づいて駆動し、電磁比例弁から出力されるパイロット圧油を例えば比例減圧弁121から出力されるパイロット圧油の代わりにブーム流量制御弁111に供給する構成とすることによって、所望の圧力のパイロット圧油をブーム流量制御弁111に供給できる。このような構成とした場合には、レバー操作パイロット圧油に対する補正の要否にかかわらず、追加した電磁比例弁からの圧油がブーム流量制御弁111へ供給される。
一方、パイロット圧補正部201を設けるにあたっては、従来の操作性を損なわないように構成する必要がある。前述のように電磁比例弁を設ける構成では、常に従来とは異なる構成でブーム流量制御弁111へパイロット圧油を供給するため、応答性等が変化し、操作の違和感を生む恐れがある。従来の操作性を維持するためには、補正の必要のない場合には、パイロット圧補正部201を設けない場合と同様に、例えば比例減圧弁121から出力されるレバー操作パイロット圧油をブーム流量制御弁111のパイロットポート111eに供給し、補正が必要な場合のみ、レバー操作パイロット圧を補正する構成とすることが望ましい。そこで、本実施形態では、比例減圧弁121を用いた従来のパイロット圧油供給回路を生かしつつ、安定化制御演算によって動作制限が必要と判断された場合のみ、レバー操作パイロット圧に対して補正を行うようにパイロット圧補正部201を構成する。
本実施形態の安定化制御装置190において行われる動作制限は、停止特性を変更して緩やかに停止させる緩停止と、動作速度に上限を設ける動作速度制限である。緩停止を行うためには、レバー操作パイロット圧が急激に低下する場合に、圧力の低下が緩やかになるように補正する必要がある。一方、動作速度制限を行うためには、レバー操作パイロット圧に対して上限圧を設定する必要がある。緩停止を行うための補正例を図4Aに、動作速度制限を行うための補正例を図4Bに示した。
本実施形態のパイロット圧補正部201は、前述の2種類の動作制限(緩停止と動作速度制限)を行うために、停止特性変更部211と動作速度制限部241とを備えている。比例減圧弁121から出力されたレバー操作パイロット圧油は、まず、停止特性変更部211に入力され、演算装置60内で行われる安定化制御演算により指令された緩停止の停止特性を満たすように補正される。この停止特性変更部211によって補正されたパイロット圧油は動作速度制限部241に入力され、演算装置60内で行われる安定化制御演算により指令された動作速度制限を満たすように補正される。この動作速度制限部241によって補正されたパイロット圧油は、対応するブーム流量制御弁111のブーム伸長側パイロットポート111eに入力される。
本実施形態のパイロット圧補正部201において、停止特性変更部211は、緩停止用電磁比例弁221と緩停止用高圧選択部231とから構成され、動作速度制限部241は速度制限用電磁比例弁251から構成される。緩停止用電磁比例弁221および速度制限用電磁比例弁251は後述する演算装置60から出力される指令信号により駆動される。
・停止特性変更部
本実施形態のブーム伸長停止特性変更部211は、上述したように緩停止用電磁比例弁221と緩停止用高圧選択部231とから構成される。
緩停止用電磁比例弁221は、演算装置60からの指令により駆動され、パイロットポンプ102から吐出される圧油から演算装置60内の安定化制御演算部60aにより指令された緩停止を行うためのパイロット圧油(緩停止パイロット圧油)を生成する弁である。また、緩停止用高圧選択部231は、レバー操作パイロット圧油と、緩停止パイロット圧油とのうち高圧側の圧油を選択して出力するブロックである。
緩停止用電磁比例弁221は、第一ポート221a、第二ポート221b、第三ポート221c、およびソレノイド221dを備えている。第一ポート221aには作動油タンク103が、第二ポート221bにはパイロットポンプ102がそれぞれ接続される。演算装置60からの指令信号によってソレノイド221dが励磁されると、指令信号に応じた圧力の緩停止パイロット圧油が第三ポート221cに出力される。緩停止用電磁比例弁221はソレノイド221dが励磁されていない時に、第一ポート221aと第三ポート221cとを連通する弁路が全開、第二ポート221bが全閉となり、パイロットポンプ102からの圧油の供給が遮断される常時閉式の特性を持つ。したがって、ソレノイド221dが非励磁状態の場合には、第三ポート221c側の圧力はタンク圧となる。演算装置60からの指令信号によってソレノイド221dが励磁されると、第二ポート221bと第三ポート221cが連通する弁路が開く方向に駆動され、パイロットポンプ102からの圧油が第三ポート221cに出力される。緩停止用電磁比例弁221は、ソレノイド221dに与えられる指令信号が大きくなるにつれて、第三ポート221cから出力される圧油の圧力が高くなるような特性を持つ。したがって、第三ポート221cから出力される圧油の圧力を安定化制御演算部60aによって指令された緩停止の停止特性を満たす圧力とするように、演算装置60からソレノイド221dに対して駆動指令を行えば良い。
緩停止用高圧選択部231は、例えばシャトル弁であって、比例減圧弁121から出力されるレバー操作パイロット圧油と緩停止用電磁比例弁から出力される緩停止パイロット圧油とが入力される。緩停止用高圧選択部231は、入力されたレバー操作パイロット圧油と緩停止パイロット圧油とのうち高圧側の圧油を選択して、停止特性変更部211の出力とする。
レバー操作パイロット圧が安定化制御演算部60aにより指令された緩停止の停止特性よりも急激に低下する場合には、緩停止パイロット圧がレバー操作パイロット圧よりも高くなり、緩停止用高圧選択部231により緩停止用パイロット圧油が選択され、指令された停止特性の緩停止が実現される。一方、安定化制御演算部60aによって指令された停止特性よりも緩やかに停止するような操作が行われた場合には、レバー操作パイロット圧が緩停止パイロット圧よりも緩やかに低下するため、緩停止パイロット圧に対してレバー操作パイロット圧が高く、緩停止用高圧選択部231においてレバー操作パイロット圧油が選択される。したがって、この場合には、停止特性変更部211においてレバー操作パイロット圧油は補正されることなく出力される。また、停止特性変更部211におけるパイロット圧油の圧力の補正は、急激に動作速度が低下するような操作が行われた場合を対象としており、それ以外の定常的な動作指令操作時や増速操作時等には緩停止用電磁比例弁221は駆動されない。したがって、このような操作時にも、緩停止用高圧選択部231においてレバー操作パイロット圧油が選択され、レバー操作パイロット圧油は補正されることなく出力される。
・動作速度制限部
本実施形態では、上述したように、ブーム伸長動作速度制限部241として速度制限用電磁比例弁251を備えている。速度制限用電磁比例弁251は、ブーム流量制御弁111に供給されるパイロット圧油に対し、演算装置60内の安定化制御演算部60aによって指令された動作速度制限を満たすように上限圧を設定する。
図5Bに示すように、速度制限用電磁比例弁251は、第一ポート251a、第二ポート251b、第三ポート251c、およびソレノイド251dを備えている。第一ポート251aには作動油タンク103が、第二ポート251bには緩停止用高圧選択部231の出力ポートが、第三ポート251cにはブーム流量制御弁111のブーム伸長側パイロットポート111eがそれぞれ接続される。第三ポート251cから出力される圧油が、パイロット圧補正部201による補正パイロット圧油である。
速度制限用電磁比例弁251は、緩停止用電磁比例弁221と同様、ソレノイド251dが励磁されていない場合には、速度制限用電磁比例弁251の第一ポート251aと第三ポート251cを連通する弁路が全開、第二ポート251bが全閉となる常時閉式の特性を有している。したがって、ソレノイド251dが励磁されていない場合には、ブーム流量制御弁111のブーム伸長側パイロットポート111eは作動油タンク103と連通され、補正パイロット圧はタンク圧となる。一方、演算装置60からの指令信号によってソレノイド251dが励磁されると、第二ポート251bと第三ポート251cとを連通する弁路が開く方向に駆動され、停止特性変更部211から第二ポート251bに供給されるパイロット圧油が、第三ポート251cに出力される。第二ポート251bと第三ポート251cとを連通する弁路を流通する圧油の圧力は、ソレノイド251dに与えられる指令信号の大きさによって決定される。ここで、指令信号によって決定されるのは流通する圧油の上限圧であり、補正パイロット圧は、第二ポート251bに供給される圧油の圧力と、ソレノイド251dに与えられる指令信号によって決定される上限圧との低い方となる。また、ソレノイド251dに対して最大の指令信号を与えた場合には、第二ポート251bに供給される圧油の圧力によらず、第二ポート251bと第三ポート251cとを連通する弁路が全開となり、補正パイロット圧は停止特性変更部211の出力圧と等しくなる。停止特性変更部211の出力圧が安定化制御演算部60aによって指令された動作速度制限を満たす上限圧よりも高い場合には、パイロット圧油は速度制限用電磁比例弁251によって減圧され、指令された動作速度制限が実現される。一方、停止特性変更部211の出力圧が上限圧よりも低い場合には、パイロット圧油は速度制限用電磁比例弁251によって補正されず、停止特性変更部211の出力するパイロット圧油がブーム流量制御弁111のブーム伸長側パイロットポート111eに供給される。また、安定化制御演算部60aにおいて動作速度制限指令が行われない場合も、パイロット圧油は速度制限用電磁比例弁251によって補正されない。
以上で説明したように、本実施形態の停止特性変更部211は指令された緩停止を行うために、レバー操作パイロット圧油の補正が必要な場合のみ、緩停止用電磁比例弁221により緩停止パイロット圧油を出力し、補正の必要がない場合には、従来のパイロット圧油供給回路と同様、比例減圧弁121から出力されるレバー操作パイロット圧油を出力する。
本実施形態の動作速度制限部241は、指令された動作速度制限を行うために停止特性変更部211から供給されるパイロット圧油を補正する必要がある場合のみ、速度制限用電磁比例弁251によりパイロット圧油を減圧し、補正の必要のない場合には、停止特性変更部211から供給されるパイロット圧油をそのまま出力する。つまり、緩停止指令および動作速度制限指令のいずれの指令も行われない場合や、レバー操作パイロット圧が緩停止指令および動作速度制限指令を満たしている場合には、停止特性変更部211および動作速度制限部241において、レバー操作パイロット圧は補正されず、従来のパイロット圧油供給回路と同様、比例減圧弁121から出力されるレバー操作パイロット圧油がブーム流量制御弁111のブーム伸長側パイロットポート111eに供給される。このように、従来のパイロット圧油供給回路を生かした構成とすることによって、従来の操作性に影響を与えることなく、動作制限を行うことができる。
<演算装置>
演算装置60は図示しないCPU、ROM(Read Only Memory)、RAM(Random Access Memory)、およびフラッシュメモリ等からなる記憶部、およびこれらを備えているマイクロコンビュータ並びに図示しない周辺回路などから構成され、例えばROMに格納されるプログラムにしたがって作動する。
演算装置60は、作業機械1の各部に取り付けられた各センサからの信号が入力される入力部60x、入力部60xに入力される信号を受けて所定の演算を行う演算部60z、演算部60zからの出力信号を受けてパイロット圧補正部200への駆動指令を出力する出力部60yを備えている。
<演算部>
以下、図3を参照して演算部60zの詳細を説明する。
演算部60zは、状態量検出部30から取り込まれる信号に応じて作業機械1を安定に保つために必要な動作制限を算出する安定化制御演算部60aと、安定化制御演算部60aからの出力に基づいてパイロット圧補正部200への駆動指令を算出する指令値生成部60iとから構成される。
<安定化制御演算部>
前述のように、本実施形態の安定化制御装置190では、作業機械1を安定に保つための動作制限として、緩停止と動作速度制限を行う。安定化制御演算部60aは、状態量検出部30の検出結果に基づいて作業機械1の安定性を評価し、この安定性評価結果に基づいて動作制限の要否を判定し、動作制限が必要な場合には緩停止指令値および動作速度制限値を出力する。
作業機械1の安定性の評価方法および動作制限の決定方法は、種々の方法が考えられるが、本実施形態では、安定性評価指標としてZMP(Zero Moment Point)を用い、急停止時の挙動予測に基づいて動作制限を算出する方法を適用する場合を例にとって説明する。
前述のように、操作レバー50を操作状態から瞬時に停止指令状態に戻すような急停止操作時には、転倒方向に大きな慣性力が働き、作業機械1が不安定になりやすい。そのため、本実施形態の安定化制御演算部60aでは、急停止操作が行われると仮定した場合の作業機械1の挙動を予測し、急停止操作時にも安定状態が保たれるように動作制限を決定する。
作業機械1を安定に保つための動作制限を算出する方法は、安定条件からの逆演算による方法と、適用する動作制限を変えて挙動予測および安定性評価を複数回繰り返す順演算による方法とがある。前者は一度の演算で最適な動作制限を算出できるが、複雑な演算式を導出する必要がある。一方、後者は、複数回の試行が必要であるが、比較的簡易な演算式を用いることができる。以下では、後者の手法を例にとって説明する。
図3に示すように、安定化制御演算部60aは、速度推定部60bと、急停止時挙動予測部60cと、安定性判定部60dと、動作制限決定部60hの各機能ブロックから構成される。速度推定部60bでは、状態量検出部30の検出結果から各駆動アクチュエータの動作速度を推定する。急停止時挙動予測部60cでは、急停止操作が行われると仮定し、作業機械1が完全に停止するまでの作業機械1の挙動を予測する。安定性判定部60dでは、急停止時挙動予測部60cの予測結果に基づき、急停止過程のZMP軌跡を算出し、安定性を判定する。そして、動作制限決定部60hでは、安定性判定部60dの判断結果に基づいて、動作制限の要否を判断し、緩停止指令および動作速度制限指令を出力する。
・ZMPに基づく安定性評価
安定化制御演算部60aの各機能ブロックの詳細を説明する前に、本実施形態において作業機械1の安定性の評価に用いるZMPと、ZMPを用いた安定性判定方法(ZMP安定判別規範)について説明する。なお、ZMPの概念ならびにZMP安定判別規範については「LEGGED LOCOMOTION ROBOTS:Miomir Vukobratovic著(「歩行ロボットと人工の足:加藤一郎訳,日刊工業新聞社」)により詳しく記載されている。
ZMPは、対象物に加わるモーメントがゼ口になる路面上の点を意味する。作業機械1から地表面29には重力、慣性力、外力およびこれらのモーメントが作用するが、ダランベールの原理によればこれらは地表面29から作業機械1への反作用としての床反力および床反力モーメントとつりあう。したがって、作業機械1が地表面29に安定に接地している場合、作業機械1と地表面29との接地点を凹にならないように結んだ支持多角形の辺上あるいはその内側にピッチ軸およびロール軸方向のモーメントがゼロになる点が存在する。この点をZMPと呼ぶ。逆に言えば、ZMPが支持多角形内に存在し、作業機械1から地表面29に作用する力が地表面29を押す向きであれば作業機械1は安定に接地しているといえる。
ZMPが支持多角形の中心に近いほど安定性は高く、支持多角形の内側にあれば作業機械1は安定状態を保ち、転倒することなく作業を行うことができる。一方、ZMPが支持多角形上に存在する場合には作業機械1は転倒を開始する。したがって、ZMPと作業機械1と地表面29とが形成する支持多角形とを比較することによって安定性を判定することができる。
ZMPは、重力、慣性力、外力によって発生するモーメントの釣り合いから導出される以下の方程式の式(1)を用いて算出される。
Figure 2017008501
zmp:ZMP位置ベクトル
:i番目の質点の質量
:i番目の質点の位置ベクトル
r”:i番目の質点に加わる加速度ベクトル(重力加速度含む)
:j番目の外力モーメント
:k番目の外力作用点位置ベクトル
:k番目の外力ベクトル
なお、各ベクトルはX成分、Y成分、Z成分で構成される3次元ベクトルである。
作業機械1が静止状態にあり、作業機械1に対して重力のみが働く場合のZMPは、作業機械1の重心(質量中心)の地表面29への投影点と一致する。したがって、ZMPは動的状態と静的状態との両方を考慮した重心の地表面29への投影点として扱うことが可能であり、ZMPを指標として用いることによって、作業機械1が静止している場合と動作を行っている場合との両方を統一的に扱うことができる。
<速度推定部>
速度推定部60bでは、状態量検出部30の検出結果をもとに、現在のレバー操作によって生じる各駆動アクチュエータの動作速度を推定する。一般に、作業機械1の各駆動アクチュエータの動作速度は、作業状況や負荷状態によって変化するものの、対応する操作レバー50の操作量、すなわちレバー操作パイロット圧に概ね比例して変化する。操作レバー50の操作と動作速度との間には油圧および機構による遅れが存在するため、レバー操作情報を用いることによって近未来の動作速度を予測することができる。そこで、速度推定部60bでは、過去のレバー操作パイロット圧と現在のレバー操作パイロット圧と現在の動作速度を用いて近未来の動作速度を予測する。
具体的には、速度推定部60bでは、まず、過去のレバー操作パイロット圧と現在の動作速度から速度算出モデルを同定する。次に、同定された速度算出モデルに現在のレバー操作パイロット圧を入力することにより、近未来の動作速度を予測する。速度算出モデルはエンジン回転数、負荷の大きさ、姿勢、油温等によって時々刻々と変化することが予想されるが、微小な時刻間では作業状況の変化が小さいため、モデルの変化も小さいものと考えてよい。速度推定部60bのより簡易な実現部として、操作レバー50を操作してから駆動アクチュエータが動き始めるまでのむだ時間Tと、レバー操作パイロット圧と動作速度との比例係数αとを用いる方法がある。ここで、むだ時間Tは変化しないものと仮定し、あらかじめ求めておく。T秒後の速度は、以下の手順で算出する。
(ステップ1)
秒前のレバー操作パイロット圧Plev(t−T)と現在の速度V(t)より以下の式(2)を用いて比例係数αを算出する。
Figure 2017008501
(ステップ2)
算出した比例係数αと現在のレバー操作パイロット圧Plev(t)より以下の式(3)を用いてT秒後の速度の推定値v(t+T)を算出する。
Figure 2017008501
・急停止時挙動予測部
急停止時挙動予測部60cでは、急停止指令が行われると仮定し、急停止指令時の作業機械1の挙動を予測する。現在の姿勢情報と速度推定部60bの速度推定結果と急停止モデルとから、急停止指令が行われてから駆動アクチュエータが完全に停止するまでの位置軌跡、速度軌跡、加速度軌跡を算出する。急停止モデルとしては、例えば、急停止時の速度軌跡をモデル化し、その速度軌跡から位置軌跡および加速度軌跡を算出する方法が考えられる。あらかじめ急停止指令時の速度軌跡をモデル化し、時刻tにおいて急停止指令が行われたときの時刻(操作レバー開放時刻)からt秒後のシリンダ速度をVstop(t,t)として与えたとき、t秒後のシリンダ長lstop(t,t)とシリンダ加速度astop(t,t)は、急停止開始時のシリンダ、長lstop(t,0)を用いて以下の式(4)で算出できる。
Figure 2017008501
実時間で急停止時挙動予測を行うためには、急停止時の速度軌跡を簡易なモデルでモデル化すると良い。急停止時の速度軌跡の簡易モデルとしては、1次遅れ系や多次遅れ系や多項式関数が考えられる。本実施形態の安定化制御では緩停止を行うため、急停止指令に加え、緩停止指令時の挙動についても同様のモデル化を行う。
安定性判定部60dは、この急停止時挙動予測部60cにおいて算出された急停止時軌跡を用いて、急停止過程におけるZMP軌跡を算出し、安定性を判定する。
具体的には、安定性判定部60dでは、まず、急停止時挙動予測部60cの予測結果を用いて、作業機械1の主要構成部材の重心の位置ベクトル軌跡と加速度ベクトル軌跡を算出する。そして、式(1)から導出される以下の式(5)および式(6)を用いてZMP軌跡を算出する。
Figure 2017008501
Figure 2017008501
上式のrに各主要構成部材の重心の急停止時位置ベクトル軌跡を、r”に急停止時加速度ベクトル軌跡を代入することにより、急停止時のZMP軌跡を算出することができる。
次に、算出された急停止時のZMP軌跡を用いて急停止時の安定性を判定する。前述のようにZMPが作業機械1と地表面29とで形成する支持多角形Lの十分内側の領域に存在する場合には、作業機械1は不安定になる可能性はほとんどなく、安定に作業を行うことができる。走行体2が地表面29に成立している場合、支持多角形Lは、走行体2の平面形状と等しい。したがって、走行体2の平面形状が矩形の場合、支持多角形Lは図6に示すように矩形となる。より具体的には、走行体2としてクローラを有している場合の支持多角形Lは左右のスプロケットの中心点を結んだ線を前方境界線、左右のアイドラの中心点を結んだ線を後方境界線、左右それぞれのトラックリンク外側端を左右の境界線とした四角形である。なお、前方および後方の境界は、最も前方の下部ローラおよび最も後方の下部ローラを接地点としても良い。
安定性判定部60dでは、支持多角形Lを作業機械1が不安定となる可能性が十分に低い通常領域Jと不安定となる可能性の高い安定警告領域Nとに分け、ZMPがいずれの領域にあるかを判定することによって安定性を判定する。通常、領域Jと安定警告領域Nとの境界Kは、安全率に従って決定される比率に応じて支持多角形Lを中心点側に縮小した多角形、あるいは、安全率に従って決定される長さだけ支持多角形Lを内側に移動した多角形に設定される。安定性判定部60dでは、急停止時のZMP軌跡上の全ての点が通常領域Jにある場合に、安定性判定結果を「安定」として出力する。一方、急停止時のZMP軌跡が安定警告領域Nに侵入する場合、すなわち、急停止過程のいずれかの時点でZMPが安定警告領域Nに侵入する場合には、判定結果を「不安定」として出力する。
・動作制限決定部
動作制限決定部60hでは、安定性判定部60dの判定結果を元に動作制限の要否を判定し、動作制限指令を算出する。本実施形態の安定化制御装置190では、作業機械1を安定に保つために緩停止と動作速度制限を行う。したがって、動作制限決定部60hは、動作制限指令として緩停止指令と動作速度制限指令を算出し、指令値生成部60iに出力する。
前述のように、本実施形態の安定化制御演算部60aでは、挙動予測および安定性評価を必要に応じて複数回繰り返すことにより、安定化に必要な動作制限を算出する。動作制限および繰り返し演算の要否判定方法について、図7を用いて説明する。
図7において、第一回目の試行においては、速度推定部60bの推定結果および急停止モデルを用いる設定とし(ステップS71)、挙動予測(ステップS72)および安定性の判定を行う(ステップS73)。
ステップS73における判定結果が「安定」であった場合には、動作制限を行わない(ステップS73のOK)。この場合には、「緩停止なし」、「動作速度制限ゲイン=1」を出力する(ステップS710)。
一方、安定性判定部60dの判定結果が「不安定」であった場合(ステップS73のNG)は、急停止モデルに代えて緩停止モデルを用いる設定とし(ステップS74)、設定変更後での挙動予測(ステップS75)および安定性判定を行う(ステップS76)。
ステップS76における安定性判定部60dの判定結果が「安定」であった場合(ステップS76のOK)は、動作速度制限ゲインを1とし、緩停止のみを行うように動作制限指令を行う(ステップS711)。
一方、安定性判定部60dの判定結果が「不安定」であった場合(ステップS76のNG)は、速度推定値に動作速度制限ゲインα(<1)を乗じたものと、緩停止モデルとを用いる設定とし(ステップS77)、設定変更後での挙動予測(ステップS78)および安定性判定(ステップS79)を行う。
安定性判定部60dの判定結果が「安定」であった場合(ステップS79のOK)は、緩停止指令および動作速度制限ゲインαの動作速度制限を行うように動作制限指令を行う(ステップS712)。
一方、安定性判定部60dの判定結果が「不安定」であった場合(ステップS79のNG)は、動作速度制限ゲインαを徐々に小さくし、安定性判定部60dの判定結果が「安定」となるまで、挙動予測(ステップS78)と安定性判定(ステップS79)を繰り返す。
なお、上記では、緩停止指令時に選択される停止特性が一通りである場合を例にとって説明したが、複数の停止特性を設定し、安定状態に応じて緩停止の程度を変更するように構成しでも良い。緩停止の程度を表す指標としては、停止に要する時間(停止時間)、停止に要する距離(制動距離)、減速加速度、単位時間当たりのパイロット圧の低下量(パイロット圧変化率)等が例として挙げられ、複数の設定を設ける場合には、あらかじめそれぞれの設定のおいて満たすべき停止特性を定める。また、動作制限決定部60hでは、全ての緩停止設定において安定性判定結果が不安定となった場合に初めて動作速度を制限するように動作制限指令を算出する。
<指令値生成部>
指令値生成部60iは、安定化制御演算部60aから出力された緩停止指令および動作速度制限指令に基づいて、パイロット圧補正部200の駆動指令値を生成し、演算装置60の出力部60yに出力する。
より具体的には、指令値生成部60iは、緩停止指令値から停止特性変更部210の駆動指令値を、動作速度制限ゲインから動作速度制限部240の駆動指令値を算出する。本実施形態の安定化制御装置190では、図5Aに示したように、ブーム伸長、ブーム縮小、アーム伸長、アーム縮小のそれぞれのパイロット油路に、各停止特性変更部211,212,213,214および各動作速度制限部241,242,243,244が設けられており、指令値生成部60iは、各停止特性変更部211,212,213,214および各動作速度制限部241,242,243,244に対して駆動指令値を算出する。以下では、ブーム伸長パイロット圧油の補正を例にとって、ブーム伸長停止特性変更部211およびブーム伸長動作速度制限部241の駆動指令値の算出方法を説明する。まず、ブーム伸長停止特性変更部211の駆動指令値の算出方法について説明する。
図5Bを用いて説明したように、本実施形態の停止特性変更部211は、緩停止用電磁比例弁221と緩停止用高圧選択部231とから構成されている。停止特性変更部211では、急減速操作あるいは停止操作が行われた場合に、動作制限決定部60hから出力された緩停止指令を満たすパイロット圧油を生成するように緩停止用電磁比例弁221を駆動することにより、駆動アクチュエータを緩やかに停止させる。同様に、停止特性変更部212は、緩停止用電磁比例弁222と緩停止用高圧選択部232とから構成され、動作速度制限部242は速度制限用電磁比例弁252から構成される。緩停止用電磁比例弁222および速度制限用電磁比例弁252は後述する演算装置60から出力される指令信号により駆動される。
緩停止を行うための駆動指令の算出方法は、緩停止時の停止特性の設定方法により種々考えられるが、以下では、停止特性としてブーム流量制御弁111に供給するパイロット圧油の圧力の変化率を指令し、レバー操作パイロット圧を図4Aに示す補正曲線を用いて補正する場合を例にとって説明する。
前述のように、ブーム流量制御弁111に供給するパイロット圧油の圧力と駆動アクチュエータの動作速度は比例の関係にある。このため、減速および停止操作時のレバー操作パイロット圧の変化率が指令値よりも大きい場合は指令された停止特性よりも速やかに減速し、指令値よりも小さい場合は、指令された停止特性よりも緩やかに減速する。本実施形態の安定化制御装置190において動作制限を行う必要があるのは、指令された停止特性よりも速やかに停止する場合である。
このために、指令値生成部60iでは、まず、レバー操作パイロット圧の変化率と変化率指令値を比較する。そして、レバー操作パイロット圧の変化率が変化率指令値よりも大きい場合には、図4Aに示す補正曲線を用いて、パイロット圧が変化率指令値を満たす単調減少となるように補正する。つまり、停止特性変更部211の出力するパイロット圧油の圧力を以下の式(7)のようにする。
Figure 2017008501
ここで、Plev(t)は時刻tにおけるレバー操作パイロット圧、P211(t)は時刻tにおいて停止特性変更部211の出力するパイロット圧油の圧力、kはパイロット圧変化率指令値である。停止特性変更部211においてレバー操作パイロット圧油を補正せずに出力する場合には、緩停止用電磁比例弁221を駆動する必要はなく、レバー操作パイロット圧の変化率が変化率指令値よりも大きい場合のみ、式(7)で算出される圧力の緩停止パイロット圧油を生成するように緩停止用電磁比例弁221を駆動すれば良い。したがって、緩停止用電磁比例弁221の指令圧は以下の式(8)のように算出する。
Figure 2017008501
ここで、P221c(t)は時刻tにおける緩停止用電磁比例弁221の指令圧である。
緩停止用電磁比例弁221の出力する圧油の圧力は指令信号の大きさによって決定され、指令信号と圧力との関係は、弁の出力特性として、例えば、図8Aのように与えられる。緩停止用電磁比例弁221への駆動指令値は、式(8)で算出される指令圧と緩停止用電磁比例弁221の出力特性を用いて決定する。例えば、図8Bに示した補正を行う場合の緩停止用電磁比例弁221への駆動指令値は図8Cのように算出される。
本実施形態の安定化制御装置190では、ブームシリンダ11およびアームシリンダ13に対して動作制限を行うため、ブーム伸長緩停止用電磁比例弁221、ブーム縮小緩停止用電磁比例弁222、アーム伸長緩停止用電磁比例弁、アーム縮小緩停止用電磁比例弁の4つの緩停止用電磁比例弁が備えられている。指令値生成部60iは、それぞれの緩停止用電磁比例弁に対して、それぞれの対応するレバー操作パイロット圧を用いて駆動指令値を算出する。
次に、ブーム伸長動作速度制限部241の駆動指令値の算出方法について説明する。前述のように、本実施形態では動作速度制限部241として速度制限用電磁比例弁251を備えており、速度制限用電磁比例弁251への駆動指令値によって、ブーム流量制御弁111のパイロットポートに供給されるパイロット圧油の上限圧が決定される。駆動アクチュエータの動作速度はパイロット圧に概ね比例するため、動作制限決定部60hから出力された動作速度制限ゲインに基づいて速度制限用電磁比例弁251の駆動指令値を算出すればよい。
具体的には、速度制限用電磁比例弁251に対して最大の駆動指令を与えた場合には、停止特性変更部211から速度制限用電磁比例弁251に入力されるパイロット圧油の圧力によらず、入力された圧油が補正されることなく出力される。したがって、動作速度制限ゲインが1である場合は、速度制限用電磁比例弁251に対し、最大の駆動指令を行う。
一方、動作速度制限ゲインが1未満の場合は、レバー操作パイロット圧を減ずる必要があるため、動作速度制限ゲインに応じて、レバー操作パイロット圧を減圧するように駆動指令を行う。ここで、動作速度制限ゲインは、レバー操作によって指令された動作速度からの必要な減速率を表しており、レバー操作パイロット圧に対して行うべき減圧率と考えて良い。つまり、速度制限用電磁比例弁251から出力される補正パイロット圧油の圧力を、レバー操作パイロット圧に動作速度制限ゲインを乗じた圧力以下とするように、速度制限用電磁比例弁251を駆動すれば良い。したがって、速度制限用電磁比例弁251の指令圧は以下のように算出される。
Figure 2017008501
ここで、P251c(t)は時刻tにおける速度制限用電磁比例弁251の指令圧であり、PMAXは速度制限用電磁比例弁251の定格圧力である。
緩停止用電磁比例弁221の場合と同様、速度制限用電磁比例弁251の出力する圧油の圧力は指令信号の大きさによって決定され、指令信号と圧力との関係は、弁の出力特性として、例えば、図8Aのように与えられる。速度制限用電磁比例弁251への駆動指令値は、式(9)で算出される指令圧と速度制限用電磁比例弁251の出力特性を用いて決定する。例えば、図8Bに示した補正を行う場合の速度制限用電磁比例弁251への駆動指令値は図8Dのように算出される。
本実施形態の安定化制御装置190では、ブームシリンダ11およびアームシリンダ13に対して動作制限を行うため、ブーム伸長速度制限用電磁比例弁251、ブーム縮小速度制限用電磁比例弁252、アーム伸長速度制限用電磁比例弁(図示せず)、アーム縮小速度制限用電磁比例弁(図示せず)の4つの速度制限用電磁比例弁が備えられており、指令値生成部60iは、それぞれの電磁比例弁に対して駆動指令値を算出する。駆動指令値は、それぞれ対応するレバー操作パイロット圧から式(9)を用いて算出する。このようにレバー操作パイロット圧に基づいて駆動指令を算出することによって、作業状態によってパイロット圧と動作速度との関係が変化する場合であっても、速度制限用電磁比例弁251によって、安定化制御演算部60aから指令された動作速度制限を確実に実現することができる。
<作用>
以上で説明したように、本実施形態によれば、作業機械1に対して無理な操作や誤った操作を行った場合にも、作業機械1を安定に保つために必要な動作制限が行われ、安定性を損なうことなく、作業を継続させることができる。また、本実施形態では、動作制限が必要な場合のみ、パイロット圧補正部200における補正を行い、動作制限の必要のない場合には従来と同様に比例減圧弁群から出力されるパイロット圧油を用いて駆動アクチュエータを駆動する構成を有しており、従来の操作性を損なうことなく、動作制限を行うことができる。したがって、本実施形態の安定化制御装置190により、操作性および安定性の高い作業機械を提供することができる。
<第1の実施形態の変更例>
<センサ構成>
上記の実施形態では、姿勢検出部49として作業機械1の傾きを検出するための姿勢センサ3bを設ける例を示したが、作業中に作業機械1の傾きが変化しない場合には、作業機械1の傾きを一定値とし、姿勢センサ3bを設けない構成としても良い。
また、上記の実施形態では、レバー操作量検出部50aとして、ブーム伸長操作量センサ51と、ブーム縮小操作量センサ52と、アーム伸長操作量センサ53と、アーム縮小操作量センサ54と、アタッチメント伸長操作量センサ55と、アタッチメント縮小操作量センサ56と、右旋回操作量センサ57と、左旋回操作量センサ58とを設ける例を示したが、動作制限を適用する駆動アクチュエータへのレバー操作にコいてのみセンサを設ける構成としても良い。例えば、ブームシリンダ11およびアームシリンダ13に対して動作制限を行う場合には、アタッチメント伸長操作量センサ55と、アタッチメント縮小操作量センサ56と、右旋回操作量センサ57と、左旋回操作量センサ58を省略する構成としても良い。
<対象とする駆動アクチュエータ>
上記の実施形態では、ブームシリンダ11、およびアームシリンダ13に対して動作制限を行う場合を例にとって説明したが、ブームシリンダ11、アームシリンダ13に加えて、旋回モータ7やアタッチメントシリンダ、15に対して動作制限を行うように構成しても良い。
この場合には、ブーム伸長、ブーム縮小アーム伸長、アーム縮小の各パイロット油路に加え、右旋回、左旋回、アタッチメント伸長、アタッチメント縮小の各パイロット油路に各パイロット圧補正部を設けて、指令値生成部60iにおいて、ブーム伸長、ブーム縮小、アーム伸長、アーム縮小の各パイロット圧補正部201,202,203,204への駆動指令に加えて、右旋回、左旋回、アタッチメント伸長、アタッチメント縮小の各パイロット圧補正部への駆動指令を生成するように構成すればよい。
<動作速度制限部の変更例>
以下では、パイロット圧補正部の変更例について、ブーム伸長パイロット圧油の補正を例にとって説明する。
上記の実施形態では、ブーム伸長動作速度制限部241として、常時閉式の特性を持つ速度制限用電磁比例弁251を用いる例を示したが、速度制限用電磁比例弁251は、ブーム流量制御弁111のブーム伸長側パイロットポート111eに供給するパイロット圧油の圧力を指令圧まで減圧する機能を有すれば良く、必ずしも上記の特性を持つ弁である必要はない。例えば、速度制限用電磁比例弁251の他の例としては、図9Aに示すような常時開式の特性を持つ電磁比例弁が挙げられる。
具体的には、図9Aに示すように、速度制限用電磁比例弁251を常時開式の電磁比例弁とする。この場合、ソレノイド251dが励磁されていない時には、第二ポート251bと第三ポート251cとを連通する弁路が全開、第一ポート251aが全閉となり、停止特性変更部211からのパイロット圧油が減圧されることなくブーム流量制御弁111のブーム伸長側パイロットポート111eに供給される。これに対し、演算装置60からの指令信号によってソレノイド251dが励磁されると、第二ポート251bと第三ポート251cとを連通する弁路が閉じる方向に駆動され、停止特性変更部211からのパイロット圧油が指令圧まで減圧される。また、ソレノイド251dへの指令信号が最大である場合には、第一ポート251aと第三ポート251cとを連通する弁路が全開、第二ポート251bが全閉となる。このとき、ブーム流量制御弁111へのパイロット圧油の供給は停止され、ブーム流量制御弁111のパイロットポートに接続されるパイロット油路の圧油は作動油タンク103に排出される。
このような特性を有する電磁比例弁を用いる場合には、指令値生成部60iにおいて、動作制限決定部60hから出力される動作速度制限ゲインが1の場合はソレノイド251dを非励磁状態とし、動作速度制限ゲインが1未満の場合は速度制限用電磁比例弁251の指令圧を式(9)によって算出される圧力とするように駆動指令を行う。
速度制限用電磁比例弁251として常時閉式の電磁比例弁を用いる場合と常時開式を用いる場合の特徴を説明する。
図5Bに示すような常時閉式とする場合には、演算装置60や、演算装置60と速度制限用電磁比例弁251とを接続する電気回路に不具合が生じ、ソレノイド251dへの指令信号が与えられなかった場合に、ソレノイド251dが非励磁状態となり、ブーム流量制御弁111へのパイロット圧油の供給が停止され、駆動アクチュエータは停止状態となる。一方、速度制限用電磁比例弁251を常時開式とすると、ソレノイド251dへの指令信号が与えられなかった場合には、停止特性変更部211の出力するパイロット圧油がブーム流量制御弁111へ供給されるため、動作速度が制限されないまま、駆動アクチュエータの動作が継続される。
また、常時閉式の速度制限用電磁比例弁251を用いる場合には、動作速度制限部241において補正の必要がない時に、常に演算装置60から最大の指令信号を出力する必要があるが、常時開式を用いる場合には指令信号を零とすれば良く、必要な電流量は常時開式を用いるほうが少なくなる傾向がある。
したがって、安全性の観点では常時閉式が、利便性、電流量の観点では常時開式が優れている。いずれの特性の電磁比例弁を用いるかは、適用する作業機械において求められる安全性、利便性、および演算装置の性能を考慮して決定すれば良い。
また、上記の実施形態では、動作速度制限部241として速度制限用電磁比例弁251を設ける例を示したが、動作速度制限部241は、ブーム流量制御弁111に供給するパイロット圧油の圧力を指令圧まで減圧する機能を有すればよく、電磁比例弁以外の他の構成を用いても良い。他の構成例として、速度制限用電磁比例弁251に代えて速度制限用電磁比例リリーフ弁261を備えている構成が考えられる。動作速度制限部として速度制限用電磁比例リリーフ弁261を備えている場合のブーム伸長パイロット圧補正部201の概略構成を図9Bに示した。
具体的には、図9Bに示すように、速度制限用電磁比例リリーフ弁261は、入力ポート261aとタンクポート261bとソレノイド261cとを備えており、入力ポート261aは停止特性変更部211とブーム流量制御弁111のブーム伸長側パイロットポート111eとを接続するパイロット油路に、タンクポート261bは作動油タンク103にそれぞれ接続される。ソレノイド261cは演算装置60からの指令信号によって励磁され、その指令信号の大きさによって、速度制限用電磁比例リリーフ弁261の設定圧が決定される。
速度制限用電磁比例リリーフ弁261では、入力ポート261a側の圧力が設定圧よりも高い場合には、入力ポート261aとタンクポート261bとを連通する弁路が開き、入力ポート261aに接続される油路の圧油が作動油タンク103に排出される。これにより、入力ポート261a側の圧力、すなわち、停止特性変更部211からブーム流量制御弁111のブーム伸長側パイロットポート111eへ供給されるパイロット圧油の圧力は、設定圧以下に保たれる。また、入力ポート261aとタンクポート261bとを連通する弁路が全閉である場合には、パイロット圧油は速度制限用電磁比例リリーフ弁261によって補正されない。したがって、速度制限用電磁比例リリーフ弁261の設定圧を、安定化制御演算部60aによって指令された動作速度制限を満たす上限圧とすることによって、速度制限用電磁比例弁251を用いる場合と同様に、動作速度制限を行うことができる。
動作速度制限部241として速度制限用電磁比例リリーフ弁261を用いる場合には、指令値生成部60iにおいて、動作制限決定部60hから出力される動作速度制限ゲインが1の場合は、設定圧が最大となるように駆動指令値を算出すれば良い。また、動作速度制限ゲインが1未満の場合は、設定圧が式(9)によって算出される指令圧となるように駆動指令値を算出すれば良い。
<緩停止用電磁比例弁の駆動指令>
上記の実施形態では、指令値生成部60iにおいて、レバー操作パイロット圧が指令された停止特性よりも急激に低下する場合のみ、緩停止用電磁比例弁221へ駆動指令を行う例を示した。そして、上記の例では、レバー操作パイロット圧が低下しない場合や、指令された停止特性よりも緩やかに低下する場合には指令信号を零とした。
しかし、一般に電磁比例電磁弁へ駆動信号を行ってから出力される圧油が指令圧になるまでには、ある程度の遅れがある。緩停止用電磁比例弁221の応答性が低い場合には、指令圧までの立ち上がりのタイムラグにより、圧力が一時的に低下し、正確に緩停止が行われない可能性がある。このような問題を回避するために、緩停止用電磁比例弁221に対し、常に待機信号を与えるように構成しても良い。この場合の待機信号の大きさは、緩停止パイロット圧がレバー操作パイロット圧を超えない大きさとし、緩停止用電磁比例弁221の応答性を考慮して決定すればよい。
<動作速度制限指令算出方法の変更例>
上記の実施形態では、動作制限決定部60hにおいて動作速度制限ゲインを算出し、指令値生成部60iにおいて、動作速度制限ゲインとレバー操作パイロット圧とを用いて速度制限用電磁比例弁251の駆動指令値を算出する例を示した。このような構成とすることにより、パイロット圧と動作速度との関係が作業状態によって変化する場合においても、適切に動作速度制限を行うことができる。
一方、作業状態によらず、パイロット圧から動作速度が一意に決定される場合には、以下のように構成しても良い。動作制限決定部60hにおいて、動作速度制限ゲインを算出する代わりに、動作速度の上限値を算出する。また、指令値生成部60iにおいて、パイロット圧と動作速度との関係式を用いて、動作速度上限値からパイロット圧上限値を算出し、このパイロット圧上限値を速度制限用電磁比例弁251の指令圧として、駆動指令を行う。
<第2の実施形態>
本発明の作業機械の第2の実施形態を図10を用いて説明する。
本実施形態では、停止特性変更部210として、第1の実施形態で用いた緩停止用電磁比例弁221,222を含む緩停止用電磁比例弁群と緩停止用高圧選択部231,232を含む緩停止用高圧選択部群とに代えて、緩停止用電磁比例圧力保持弁271,272を含む電磁比例圧力保持弁群と緩停止用逆止弁281,282を含む逆止弁群とを用いる。以下では、図10を参照し、主に第1の実施形態との相違点を説明する。なお、図1乃至図9Bと同じ構成には同一の符号を示し、説明は省略する。以下の実施形態においても同様とする。
<パイロット圧補正部>
本実施形態のパイロット圧補正部200は、第1の実施形態と同様、停止特性変更部210と動作速度制限部240とから構成される。安定化制御演算に基づく動作制限をブームシリンダ11およびアームシリンダ13に対して適用するために、作業機械1には、パイロット圧補正部200として、ブーム伸長パイロット圧補正部201、ブーム縮小パイロット圧補正部202、アーム伸長パイロット圧補正部(図示せず)、アーム縮小パイロット圧補正部(図示せず)が設けられる。各パイロット圧補正部201,202の構成はいずれについても同様の構成であり、ブーム伸長パイロット圧補正部201はブーム伸長停止特性変更部211とブーム伸長動作速度制限部241を備え、ブーム縮小パイロット圧補正部202はブーム縮小停止特性変更部212とブーム縮小動作速度制限部242を備えている。図示しないアーム伸長パイロット圧補正部も同様にアーム伸長停止特性変更部とアーム伸長動作速度制限部を備え、アーム縮小パイロット圧補正部もアーム縮小停止特性変更部とアーム縮小動作速度制限部を備えている。本実施形態の各動作速度制限部241,242…の構成は第1の実施形態と同様である。以下では、ブーム伸長パイロット圧油の補正を例にとり、ブーム伸長停止特性変更部211についてのみ説明する。
<停止特性変更部>
本実施形態のブーム伸長停止特性変更部211は、電磁比例圧力保持弁群としての緩停止用電磁比例圧力保持弁271と逆止弁群としての緩停止用逆止弁281とから構成される。
緩停止用逆止弁281は、圧油の流れ方向を制限する弁であり、緩停止用電磁比例圧力保持弁271は、パイロット圧油の作動油タンク103への排出を制御する弁である。緩停止用逆止弁281および緩停止用電磁比例圧力保持弁271は、比例減圧弁121と動作速度制限部241とを接続する油路に並列に設けられる。すなわち、比例減圧弁121と動作速度制限部241との間には、緩停止用逆止弁281を備えたパイロット油路と緩停止用電磁比例圧力保持弁271を備えたパイロット油路とが設けられており、圧油はいずれかの油路を流通する。以下では緩停止用逆止弁281と緩停止用電磁比例圧力保持弁271の詳細を説明する。
緩停止用逆止弁281は、圧油の流れ方向を制限する弁であって、入力ポート281aおよび出力ポート281bを備えている。緩停止用逆止弁281の入力ポート281aには比例減圧弁121の第三ポート121cが、出力ポート281bには動作速度制限部241を構成する速度制限用電磁比例弁251の第二ポート251bが接続され、比例減圧弁121から動作速度制限部241への圧油の流れを自由流れとし、動作速度制限部241から比例減圧弁121への圧油の流れを遮断する。したがって、圧油は、比例減圧弁121から動作速度制限部241へ流通する場合には、緩停止用逆止弁281を備えたパイロット油路を通り、動作速度制限部241から比例減圧弁121へ流通する場合には緩停止用電磁比例圧力保持弁271を備えたパイロット油路を流通する。
前述のように、パイロット油路の圧油の流れの方向は、操作レバー50の操作状態によって決定される。操作レバー50を、比例減圧弁121から出力されるレバー操作パイロット圧を増大させる方向に操作した場合には、比例減圧弁121からパイロット油路へパイロット圧油が供給され、レバー操作パイロット圧を低下させる方向に操作した場合には、パイロット油路の圧油が比例減圧弁121の第一ポート121aと第三ポート121cとを連通する弁路を流通して作動油タンク103に排出される。したがって、本実施形態の停止特性変更部211は、レバー操作パイロット圧を増大させる場合の圧油の供給を自由流れとし、レバー操作パイロット圧を低下させる場合、すなわち、駆動アクチュエータを減速させる場合の圧油の流通を緩停止用電磁比例圧力保持弁271よって制御する構成である。
緩停止用電磁比例圧力保持弁271は、第一ポート271a、第二ポート271b、およびソレノイド271cを備えており、第一ポート271aは速度制限用電磁比例弁251の第二ポート251bと、第二ポート271bは比例減圧弁121の第三ポート121cとそれぞれ接続される。ソレノイド271cは演算装置60からの指令信号によって励磁され、その指令信号の大きさによって、緩停止用電磁比例圧力保持弁271の保持圧が決定される。
緩停止用電磁比例圧力保持弁271では、第一ポート271a側の圧力が保持圧よりも高い場合には、第一ポート271aと第二ポート271bとを連通する弁路が開き、第一ポート271aから第二ポート271bへ圧油が供給される。前述のように、圧油が緩停止用電磁比例圧力保持弁271を通過するのは、動作速度制限部241から比例減圧弁121へ圧油が流通する場合のみであり、この時、比例減圧弁121に供給された圧油は、比例減圧弁121の第一ポート121aと第三ポート121cとを連通する弁路を流通して作動油タンク103へ排出される。つまり、緩停止用電磁比例圧力保持弁271は、緩停止用電磁比例圧力保持弁271と動作速度制限部241とを連結するパイロット油路の圧油の圧力が保持圧よりも高い場合には圧油を作動油タンク103に排出し、保持圧よりも低い場合には作動油タンク103への排出を遮断する。これによって、パイロット圧油の圧力を保持圧に保つ。
ソレノイド271cが励磁されていない場合には、パイロット油路の圧油の圧力によらず、第一ポート271aと第二ポート271bとを連通する弁路が全開となり、作動油タンク103への排出が自由に行われる。
一方、緩停止用電磁比例圧力保持弁271に対して最大の駆動指令を行うと、第一ポート271aと第二ポート271bとを連通する弁路が閉じ状態となり、駆動アクチュエータを減速あるいは停止させるように操作レバー50を操作した場合においても、パイロット油路の圧油が作動油タンク103に排出されない。このとき、動作速度制限部241に供給されるパイロット圧油の圧力はレバー操作によって比例減圧弁121から出力されたレバー操作パイロット圧の最大圧に保たれ、駆動アクチュエータは減速されることなく動作を継続する。
このように、緩停止用電磁比例圧力保持弁271の保持圧を緩やかに低下させることにより、パイロット圧油の圧力を緩やかに低下させ、駆動アクチュエータを緩やかに減速させることができる。したがって、緩停止用電磁比例圧力保持弁271の保持圧を、安定化制御演算部60aによって指令された緩停止の停止特性を満たす圧力とすることによって、緩停止用電磁比例弁221を用いる場合と同様に、指令された緩停止を行うことができる。
<演算装置>
演算装置60は、第1の実施形態と同様に、作業機械1の各部に取り付けられた各センサからの信号が入力される入力部60x、入力部60xに入力される信号を受けて所定の演算を行う演算部60z、演算部60zからの出力信号を受けてパイロット圧補正部200への駆動指令を出力する出力部60yを備えている。演算部60zは、作業機械1を安定に保つための動作制限を算出する安定化制御演算部60aと、パイロット圧補正部200への駆動指令を算出する指令値生成部60iとから構成される。
第2の実施形態の演算装置60において、第1の実施形態と異なるのは、指令値生成部60iにおける停止特性変更部210への駆動指令の算出方法のみである。以下では、ブーム伸長パイロット圧油の補正を例にとり、指令値生成部60iにおける緩停止用電磁比例圧力保持弁271への駆動指令の算出方法についてのみ説明する。
<指令値生成部>
本実施形態のブーム伸長停止特性変更部211は、緩停止用逆止弁281と緩停止用電磁比例圧力保持弁271とから構成されており、停止特性変更部211の出力するパイロット圧油が動作制限決定部60hから出力された緩停止指令を満たす圧力となるように、緩停止用電磁比例圧力保持弁271を駆動することにより、駆動アクチュエータを緩やかに停止させる。
以下では、第1の実施形態と同様に、停止特性としてブーム流量制御弁111に供給するパイロット圧油の圧力の変化率を指令し、レバー操作パイロット圧を図4Aに示す補正曲線を用いて補正する場合を例にとって、緩停止用電磁比例圧力保持弁271への駆動指令値の算出方法を説明する。
本実施形態において指令された緩停止を行うためには、停止特性変更部211の出力圧を式(7)で算出される圧力とする必要がある。緩停止用電磁比例圧力保持弁271を圧油が流通しない場合や、緩停止用電磁比例圧力保持弁271において出力圧を補正する必要がない場合には、緩停止用電磁比例圧力保持弁271を駆動する必要はない。つまり、レバー操作パイロット圧の変化率が変化率指令値よりも大きい場合のみ、保持圧を式(7)で算出される圧力とするように駆動すればよい。したがって、緩停止用電磁比例圧力保持弁271の保持圧は、第1の実施形態の緩停止用電磁比例弁221の指令圧と同様に式(8)を用いて算出される圧力とすればよい。また、緩停止用電磁比例圧力保持弁271の保持圧はソレノイド271cに与えられる指令信号の大きさによって決定され、指令信号と圧力との関係は、弁の出力特性としてあらかじめ与えられる。したがって、緩停止用電磁比例圧力保持弁271への駆動指令値は式(8)で算出される保持圧と、弁の出力特性とを用いて算出する。
<特長>
本実施形態のような態様の停止特性変更部211を用いると、定常的な動作指令操作時や増速操作時等、レバー操作パイロット圧を低下させないような操作時には、レバーパイロット圧油は緩停止用逆止弁281を備えた油路を流通し、補正されることなく出力される。また、安定化制御演算部60aにより指令された緩停止の停止特性よりも緩やかに停止させるような操作が行われた場合にも、緩停止用電磁比例圧力保持弁271による補正は行われない。
一方、レバー操作パイロット圧が安定化制御演算部60aから指令された緩停止の停止特性よりも急激に低下する場合には、緩停止用電磁比例圧力保持弁271は、停止特性変更部211の出力圧が指令された緩停止の停止特性を満たす圧力となるように駆動され、緩停止用電磁比例圧力保持弁271によってパイロット圧油の作動油タンク103への排出が制御され、指令された停止特性の緩停止が実現される。
したがって、本実施形態の停止特性変更部211は第1の実施形態の停止特性変更部211と同様、レバー操作パイロット圧油の圧力が安定化制御演算部60aから指令された緩停止指令を満たさない場合のみ補正を行う構成であり、従来の操作性に影響を与えることなく、動作制限を行うことができる。
また、本実施形態の停止特性変更部211は、緩停止用逆止弁281により、比例減圧弁121からブーム流量制御弁111へのパイロット圧油の流れを自由流れとしていることから、緩停止用電磁比例圧力保持弁271は、ソレノイド271cの駆動状態によらず、駆動アクチュエータを駆動する方向の圧油の流通に影響を及ぼさない。
また、第1の実施形態の停止特性変更部211では、パイロットポンプ102の吐出する圧油を用いて緩停止パイロット圧を生成するのに対し、第2の実施形態の停止特性変更部211では、パイロット圧油の作動油タンクへの排出を制御することによってパイロット圧の低下を緩やかにして緩停止を実現する。つまり、第2の実施形態では、緩停止をパイロット油路へ新たに圧油を流入することなく実現しており、緩停止用電磁比例圧力保持弁271に対して誤った指令信号が与えられた場合にも、操作レバーが非操作状態において駆動アクチュエータが動作する恐れがなく、安全性が高い、との利点を有している。
<第3の実施形態>
本発明の作業機械の第3の実施形態を図11を用いて説明する。
第2の実施形態では、停止特性変更部210として緩停止用逆止弁281,282を含む逆止弁群と緩停止用電磁比例圧力保持弁271,272を含む電磁比例圧力保持弁群を用いたが、本実施形態では緩停止用電磁比例圧力保持弁271,272を含む電磁比例圧力保持弁群に代えて、緩停止用電磁比例流量制御弁291,292電磁比例流量制御弁群を用いる。以下では、図11を参照し、主に第1および第2の実施形態との相違点を説明する。
<パイロット圧補正部>
本実施形態のパイロット圧補正部200は、第1および第2の実施形態と同様、停止特性変更部210と動作速度制限部240とから構成される。作業機械1には、パイロット圧補正部200として、ブーム伸長パイロット圧補正部201、ブーム縮小パイロット圧補正部202、アーム伸長パイロット圧補正部(図示せず)、アーム縮小パイロット圧補正部(図示せず)が設けられる。各パイロット圧補正部201,202の構成はいずれについても同様の構成であり、ブーム伸長パイロット圧補正部201はブーム伸長停止特性変更部211とブーム伸長動作速度制限部241を備え、ブーム縮小パイロット圧補正部202はブーム縮小停止特性変更部212とブーム縮小動作速度制限部242を備えている。図示しないアーム伸長パイロット圧補正部はアーム伸長停止特性変更部とアーム伸長動作速度制限部を備え、アーム縮小パイロット圧補正部もアーム縮小停止特性変更部とアーム縮小動作速度制限部を備えている。本実施形態の各動作速度制限部241,242…は第1の実施形態と同様である。以下では、ブーム伸長パイロット圧油の補正を例にとり、ブーム伸長停止特性変更部211についてのみ説明する。
<停止特性変更部>
本実施形態のブーム伸長停止特性変更部211は、緩停止用逆止弁281と緩停止用電磁比例流量制御弁291とから構成される。緩停止用逆止弁281は、圧油の流れ方向を制限する弁であり、緩停止用電磁比例流量制御弁291は、パイロット油路の圧油の作動油タンク103への排出を制御する弁である。
緩停止用電磁比例流量制御弁291は、第2の実施形態の緩停止用電磁比例圧力保持弁271の代わりに設けられる弁であり、緩停止用逆止弁281および緩停止用電磁比例流量制御弁291は、比例減圧弁121と動作速度制限部241とを接続する油路に並列に設けられる。
緩停止用逆止弁281の構成および作用は第2の実施形態と同様であり、本実施形態の停止特性変更部211は、レバー操作パイロット圧を増大させる場合の圧油の供給を自由流れとし、レバー操作パイロット圧を低下させる場合、すなわち、駆動アクチュエータを減速させる場合の圧油の流通を緩停止用電磁比例流量制御弁291よって制御する構成である。以下では、緩停止用電磁比例流量制御弁291の詳細を説明する。
緩停止用電磁比例流量制御弁291は、第一ポート291a、第二ポート291b、およびソレノイド291cを備えており、第一ポート291aは速度制限用電磁比例弁251の第二ポート251bと、第二ポート291bは比例減圧弁121の第三ポート121cとそれぞれ接続される。第一ポート291aと第二ポート291bとを連通する弁路には開度を変更可能な絞り291dが設けられている。ソレノイド291cは演算装置60からの指令信号によって励磁され、その指令信号の大きさによって、絞り291dの開度が決定される。
前述のように、圧油が緩停止用電磁比例流量制御弁291を通過するのは、動作速度制限部241から比例減圧弁121へ圧油が流通する場合のみであり、緩停止用電磁比例流量制御弁291は、駆動アクチュエータを減速させる操作が行われた場合のパイロット圧油の作動油タンク103への排出を制御する機能を持つ。絞り291dの開度によって第一ポート291aと第二ポート291bを連通する弁路を流通する圧油の流量が決定される。
具体的には、絞り291dの開度が大きい場合には、弁路を流通できる流量が大きく、パイロット圧油は作動油タンク103へ速やかに排出される。それに伴い、パイロット圧油の圧力は速やかに低下する。絞り291dの開度を最大とした場合には、圧油の流通は自由流れとなる。一方、絞り291dの開度を小さくすると、第一ポート291aから第二ポート291bへ流通する圧油の流量が制限され、パイロット圧油の作動油タンク103への排出が緩やかになるため、パイロット圧油の圧力は緩やかに低下する。したがって、緩停止用電磁比例流量制御弁291の絞り291dの開度を適切に調整することにより、指令された停止特性の緩停止を行うことができる。
<演算装置>
演算装置60は、第1および第2の実施形態と同様に、作業機械1の各部に取り付けられた各センサからの信号が入力される入力部60x、入力部60xに入力される信号を受けて所定の演算を行う演算部60z、演算部60zからの出力信号を受けて、パイロット圧補正部200への駆動指令を出力する出力部60yを備えている。演算部60zは、作業機械1を安定に保つための動作制限を算出する安定化制御演算部60aと、パイロット圧補正部200への駆動指令を算出する指令値生成部60iとから構成される。
第3の実施形態の演算装置において、第1および第2の実施形態と異なるのは、指令値生成部60iにおける停止特性変更部210への駆動指令の算出方法のみである。以下では、ブーム伸長パイロット圧油の補正を例にとり、指令値生成部60iにおける緩停止用電磁比例流量制御弁291への駆動指令の算出方法について説明する。
<指令値生成部>
本実施形態のブーム伸長停止特性変更部211は、緩停止用逆止弁281と緩停止用電磁比例流量制御弁291とから構成されており、緩停止用電磁比例流量制御弁291の内部に設けられた絞り291dの開度を適切に調整することによって、駆動アクチュエータの停止特性を所望の特性へ変更する。
前述のとおり、駆動アクチュエータを減速させる操作を行った場合、動作速度制限部241へ供給されるパイロット圧油の圧力は、絞り291dの開度を大きくするほど急激に低下し、開度を小さくするほど緩やかに低下する。この停止特性と絞り291dの開度との関係は、弁の流量特性としてあらかじめ与えられる。そして絞り291dの開度を最大とした場合には、圧油の流通は自由流れとなる。したがって、停止特性変更部211において、レバー操作パイロット圧の補正の必要がない場合には絞り291dの開度を最大とする。
一方、レバー操作パイロット圧が安定化制御演算部60aから出力された緩停止指令を満たさない場合には、指令された緩停止の停止特性と弁の流量特性を用いて、絞り291dの開度を決定する。緩停止用電磁比例流量制御弁291の絞り291dの開度はソレノイド291dに与えられる指令信号の大きさによって決定され、この指令信号と開度の関係もあらかじめ弁の特性として与えられる。したがって、緩停止用電磁比例流量制御弁291への駆動指令値は、前述のように決定される絞り291dの開度と、弁の出力特性とを用いて算出する。
<特長>
本実施形態の停止特性変更部211を用いると、定常的な動作指令操作時や増速操作時等、レバー操作パイロット圧を低下させないような操作時には、レバーパイロット圧油は緩停止用逆止弁281を備えた油路を流通し、補正されることなく出力される。また、安定化制御演算部60aにより指令された緩停止の停止特性よりも緩やかに停止するような操作が行われた場合には、緩停止用電磁比例流量制御弁291の絞り291dによる流量制限の影響を受けず、レバー操作パイロット圧油は補正されない。
一方、レバー操作パイロット圧が安定化制御演算部60aから指令された緩停止の停止特性よりも急激に低下する場合には、緩停止用電磁比例流量制御弁291の絞り291dによって、パイロット圧油の作動油タンクへの排出が制御され、指令された停止特性の緩停止が実現される。
したがって、本実施形態の停止特性変更部211は第1および第2の実施形態の停止特性変更部211と同様、レバー操作パイロット圧油の圧力が安定化制御演算部60aから指令された緩停止指令を満たさない場合のみ補正を行う構成であり、従来の操作性に影響を与えることなく、動作制限を行うことができる。
また、本実施形態の停止特性変更部211は、緩停止用逆止弁281により比例減圧弁121からブーム流量制御弁111へのパイロット圧油の流れを自由流れとしており、緩停止用電磁比例流量制御弁291は、ソレノイド291cの駆動状態によらず、駆動アクチュエータを駆動する方向の圧油の流通に影響を及ぼさない。また、本実施形態では、第2の実施形態と同様、パイロット圧油の作動油タンクへの排出を制御することによってパイロット圧の低下を緩やかにして緩停止を実現するため、緩停止を行うためにパイロットポンプからパイロット油路へ新たに圧油を流入させる必要がない。したがって、緩停止用電磁比例流量制御弁291に対して誤った指令信号が与えられた場合にも、操作レバーが非操作状態において駆動アクチュエータが動作する恐れがなく、安全性が高い、との利点を有している。
更に、緩停止用電磁比例流量制御弁291を用いる場合、演算部60zからの指令信号によって決定されるのは、緩停止用電磁比例流量制御弁291の絞り291dの開度、すなわち、パイロット圧油の流通流量であって、ブーム流量制御弁111に供給するパイロット圧油の圧力ではない。そのため、ブーム流量制御弁111に供給するパイロット圧油の圧力を精密に制御することはできない。一方、演算装置60の指令値生成部60iにおける指令信号の演算は簡易になる。演算装置60からの指令信号によって停止特性変更部211から出力する圧力を決定する場合には停止過程において、指令信号を時々刻々と変化させる必要があるが、緩停止用電磁比例流量制御弁291を用いる場合は、指令された停止特性に応じて絞り291dの開度を決定すれば良く、急停止操作中か否かの判定の必要がなく、また、停止過程において指令信号を変化させる必要がない。したがって、指令信号算出の演算処理が簡易になる、との利点を有している。
<その他>
なお、本発明は、上記の実施形態に限定されるものではなく、様々な変形例が含まれる。上記の実施形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えているものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることも可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。また、各実施形態の構成の一部について、他の構成の追加・削除・置換をすることも可能である。
例えば、安定判別方式は、ZMPのみで行う態様に限られず、ZMPと力学的エネルギとの2つの評価指標を用いて判別することができる。
また、緩停止を行うためのパイロット圧の補正例は、図4Aに示すようなパイロット圧が変化率指令値を満たす単調減少となるように補正する態様に限られず、減少量に変化をつけた補正とすることができる。
3…旋回体(作業機械本体)
6…作業フロント
7…旋回モータ(駆動アクチュエータ)
11…ブームシリンダ(駆動アクチュエータ)
13…アームシリンダ(駆動アクチュエータ)
15…アタッチメントシリンダ(駆動アクチュエータ)
50…操作レバー
60…演算装置
60b…速度推定部
60c…急停止時挙動予測部
60d…安定性判定部
60h…動作制限決定部
100…アクチュエータ駆動油圧回路
111…ブーム流量制御弁(流量制御弁)
121…ブーム伸長比例減圧弁
122…ブーム縮小比例減圧弁
200…パイロット圧補正部
210…停止特性変更部
240…動作速度制限部

Claims (7)

  1. 作業機械本体と、この作業機械本体に対して上下方向に揺動自在に取り付けられ複数の可動部を有する作業フロントと、この作業フロントの各可動部を駆動する駆動アクチュエータと、この駆動アクチュエータの駆動を制御する制御演算を行う演算装置と、前記駆動アクチュエータへの圧油の供給を制御する流量制御弁および操作レバーの操作に基づいて前記流量制御弁に供給するパイロット圧油を出力する比例減圧弁を有するアクチュエータ駆動油圧回路とを備えた作業機械において、
    前記演算装置は、作業機械の速度を推定する速度推定部と、前記速度推定部によって推定された速度と作業機械の姿勢に基づき、作業機械が急停止すると仮定した場合の作業機械の挙動を予測する急停止時挙動予測部と、前記急停止時挙動予測部によって予測された挙動に基づき前記作業機械の安定性を判定する安定性判定部と、前記安定性判定部の判定結果に基づき前記駆動アクチュエータの減速度を制限して前記駆動アクチュエータを緩やかに停止させる緩停止指令および前記駆動アクチュエータの上限動作速度を制限する動作速度制限指令を演算し、出力する動作制限決定部とを有し、
    前記アクチュエータ駆動油圧回路は、前記動作制限決定部からの前記緩停止指令および前記動作速度制限指令に応じて前記比例減圧弁から出力されるパイロット圧を補正するパイロット圧補正部を有し、
    このパイロット圧補正部は、前記操作レバーの停止操作時に前記駆動アクチュエータを緩やかに停止させるようにパイロット圧を補正する停止特性変更部と、前記駆動アクチュエータの動作速度を制限するようにパイロット圧を補正する動作速度制限部とから構成され、
    前記停止特性変更部および前記動作速度制限部は、前記動作制限決定部からの前記緩停止指令および前記動作速度制限指令によってそれぞれ駆動され、前記動作制限決定部から前記緩停止指令および前記動作速度制限指令が入力された場合は前記比例減圧弁から出力されるパイロット圧を補正し、前記動作制限決定部から前記緩停止指令および前記動作速度制限指令が入力されない場合には、前記比例減圧弁から出力されるパイロット圧を補正することなく前記流量制御弁に供給する
    ことを特徴とする作業機械。
  2. 請求項1に記載の作業機械において、
    前記停止特性変更部は、前記動作制限決定部から出力される前記緩停止指令の停止特性よりも速やかに停止させる操作が行われた場合に、前記比例減圧弁から出力されるパイロット圧よりも高い圧力を生成して出力する弁装置であり、
    前記動作速度制限部は、前記パイロット圧が前記動作制限決定部から出力される動作速度制限を満たすための上限圧よりも高い場合に、前記パイロット圧を前記上限圧まで減圧する弁装置である
    ことを特徴とする作業機械。
  3. 請求項1に記載の作業機械において、
    前記動作速度制限部は、電磁比例弁もしくは電磁比例リリーフ弁のいずれかを有する
    ことを特徴とする作業機械。
  4. 請求項1に記載の作業機械において、
    前記停止特性変更部は、電磁比例弁と高圧選択部とから構成され、
    前記電磁比例弁は、前記比例減圧弁以外のパイロット圧油供給部と接続されており、前記動作制限決定部から指令される設定圧のパイロット圧を生成し、
    前記高圧選択部は、前記比例減圧弁から出力されるパイロット圧と前記電磁比例弁から出力されるパイロット圧とのうち高圧側のパイロット圧を選択して出力する
    ことを特徴とする作業機械。
  5. 請求項1に記載の作業機械において、
    前記停止特性変更部は、逆止弁と電磁比例圧油排出制御弁とから構成され、
    前記逆止弁および前記電磁比例圧油排出制御弁は、前記比例減圧弁と前記流量制御弁とを接続するパイロット油路に並列に設けられており、
    前記逆止弁は、前記比例減圧弁から前記流量制御弁への圧油の流通を自由流れと、前記流量制御弁から前記比例減圧弁への圧油の流通を遮断とし、
    前記電磁比例圧油排出制御弁は、前記演算装置からの指令信号に基づいて前記流量制御弁から前記比例減圧弁への圧油の流通を制御する
    ことを特徴とする作業機械。
  6. 請求項5に記載の作業機械において、
    前記電磁比例圧油排出制御弁は、前記流量制御弁に供給されるパイロット圧が前記演算装置からの指令信号によって設定される保持圧よりも低い場合には圧油の流通を遮断し、高い場合には圧油の流通を可能とする電磁比例圧力保持弁を有する
    ことを特徴とする作業機械。
  7. 請求項5に記載の作業機械において、
    前記電磁比例圧油排出制御弁は、前記演算装置からの指令信号によって開度を変更可能な絞りを有する電磁比例流量制御弁を有し、
    前記演算装置は、前記動作制限決定部から出力される緩停止指令に基づいて前記電磁比例流量制御弁の絞り開度を決定する
    ことを特徴とする作業機械。
JP2015122306A 2015-06-17 2015-06-17 作業機械 Expired - Fee Related JP6619163B2 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP2015122306A JP6619163B2 (ja) 2015-06-17 2015-06-17 作業機械
CN201610101989.4A CN106256966B (zh) 2015-06-17 2016-02-24 作业机械
KR1020160021711A KR101814657B1 (ko) 2015-06-17 2016-02-24 작업 기계
US15/183,132 US10024032B2 (en) 2015-06-17 2016-06-15 Work machine
EP16174832.2A EP3106572B1 (en) 2015-06-17 2016-06-16 Work machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2015122306A JP6619163B2 (ja) 2015-06-17 2015-06-17 作業機械

Publications (3)

Publication Number Publication Date
JP2017008501A true JP2017008501A (ja) 2017-01-12
JP2017008501A5 JP2017008501A5 (ja) 2018-04-19
JP6619163B2 JP6619163B2 (ja) 2019-12-11

Family

ID=56132871

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2015122306A Expired - Fee Related JP6619163B2 (ja) 2015-06-17 2015-06-17 作業機械

Country Status (5)

Country Link
US (1) US10024032B2 (ja)
EP (1) EP3106572B1 (ja)
JP (1) JP6619163B2 (ja)
KR (1) KR101814657B1 (ja)
CN (1) CN106256966B (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018145753A (ja) * 2017-03-09 2018-09-20 日立建機株式会社 作業機械の操作支援装置
WO2019053936A1 (ja) * 2017-09-15 2019-03-21 日立建機株式会社 作業機械
WO2019186840A1 (ja) * 2018-03-28 2019-10-03 日立建機株式会社 作業機械
WO2021059584A1 (ja) * 2019-09-26 2021-04-01 日立建機株式会社 作業機械
JP2021188669A (ja) * 2020-05-29 2021-12-13 株式会社竹内製作所 作業用車両

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10048158B2 (en) * 2015-09-30 2018-08-14 Deere & Company Stability warning and control intervention system for a forestry vehicle
WO2018062210A1 (ja) * 2016-09-30 2018-04-05 住友重機械工業株式会社 ショベル
DE112017000130B4 (de) 2017-01-10 2022-02-17 Komatsu Ltd. Arbeitsfahrzeug und Verfahren zum Steuern desselben
US10900502B2 (en) * 2017-08-25 2021-01-26 Parker-Hannifin Corporation Direct input pilot operated servo valve
US10961690B2 (en) * 2017-09-13 2021-03-30 Hitachi Construction Machinery Co., Ltd. Work machine
JP6807293B2 (ja) * 2017-09-26 2021-01-06 日立建機株式会社 作業機械
JP6957414B2 (ja) * 2018-06-11 2021-11-02 日立建機株式会社 作業機械
CN110925255A (zh) * 2019-11-19 2020-03-27 宜昌宜硕塑业有限公司 一种比例流量阀
CN113211429A (zh) * 2021-04-07 2021-08-06 新兴际华科技发展有限公司 消防机器人高精度稳定控制方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0551947A (ja) * 1991-08-26 1993-03-02 Hitachi Constr Mach Co Ltd 建設機械のアクチユエータ制御装置
JPH0885974A (ja) * 1994-09-19 1996-04-02 Hitachi Constr Mach Co Ltd 建設機械の操作システム
JP2001199676A (ja) * 2000-01-17 2001-07-24 Hitachi Constr Mach Co Ltd 建設機械の操作系油圧回路
JP2006220193A (ja) * 2005-02-09 2006-08-24 Shin Caterpillar Mitsubishi Ltd パイロット制御装置
JP2006291647A (ja) * 2005-04-14 2006-10-26 Shin Caterpillar Mitsubishi Ltd 作業機械の干渉回避制御装置
WO2012169531A1 (ja) * 2011-06-10 2012-12-13 日立建機株式会社 作業機械
US20160115669A1 (en) * 2014-10-22 2016-04-28 Caterpillar Inc. Boom Assist Management Feature

Family Cites Families (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2871105B2 (ja) 1990-12-03 1999-03-17 油谷重工株式会社 解体作業機の安全装置
JP3091667B2 (ja) * 1995-06-09 2000-09-25 日立建機株式会社 建設機械の領域制限掘削制御装置
JP3679848B2 (ja) * 1995-12-27 2005-08-03 日立建機株式会社 建設機械の作業範囲制限制御装置
JP3550260B2 (ja) * 1996-09-30 2004-08-04 コベルコ建機株式会社 アクチュエータ作動特性制御装置
JPH11182674A (ja) * 1997-12-17 1999-07-06 Komatsu Ltd 油圧駆動車両の前後進切換制御装置および制御方法
JP3124962B2 (ja) * 1998-12-02 2001-01-15 新キャタピラー三菱株式会社 作業用機械の油圧制御回路
DE102006018706A1 (de) * 2006-04-21 2007-10-25 Robert Bosch Gmbh Hydraulische Steueranordnung
KR100791105B1 (ko) * 2006-05-23 2008-01-02 볼보 컨스트럭션 이키프먼트 홀딩 스웨덴 에이비 굴삭기 붐 속도 증속장치
JP4931048B2 (ja) * 2006-07-31 2012-05-16 キャタピラー エス エー アール エル 作業機械の制御装置
WO2009123134A1 (ja) * 2008-03-31 2009-10-08 株式会社小松製作所 建設機械の旋回駆動制御システム
JP5492229B2 (ja) * 2010-01-28 2014-05-14 日立建機株式会社 油圧作業機
JP5363430B2 (ja) * 2010-07-23 2013-12-11 日立建機株式会社 ハイブリッド式建設機械
JP5529241B2 (ja) * 2012-11-20 2014-06-25 株式会社小松製作所 作業機械および作業機械の作業量計測方法
JP6077015B2 (ja) * 2013-01-17 2017-02-08 日立建機株式会社 作業機械の圧油エネルギ回収装置
JP6053714B2 (ja) * 2014-03-31 2016-12-27 日立建機株式会社 油圧ショベル
US20170121930A1 (en) * 2014-06-02 2017-05-04 Komatsu Ltd. Construction machine control system, construction machine, and method of controlling construction machine
KR101800103B1 (ko) * 2014-06-04 2017-11-21 가부시키가이샤 고마쓰 세이사쿠쇼 작업 기계의 자세 연산 장치, 작업 기계 및 작업 기계의 자세 연산 방법
US9598841B2 (en) * 2014-06-04 2017-03-21 Komatsu Ltd. Construction machine control system, construction machine, and construction machine control method
DE102014214441B4 (de) * 2014-07-23 2016-02-18 Danfoss Power Solutions Gmbh & Co. Ohg Verfahren und Anordnung zum Verzögern eines Hydrostatischen Antriebs
CN104452849B (zh) * 2014-11-07 2017-04-05 中联重科股份有限公司渭南分公司 一种动臂优先控制设备、系统、方法及挖掘机

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0551947A (ja) * 1991-08-26 1993-03-02 Hitachi Constr Mach Co Ltd 建設機械のアクチユエータ制御装置
JPH0885974A (ja) * 1994-09-19 1996-04-02 Hitachi Constr Mach Co Ltd 建設機械の操作システム
JP2001199676A (ja) * 2000-01-17 2001-07-24 Hitachi Constr Mach Co Ltd 建設機械の操作系油圧回路
JP2006220193A (ja) * 2005-02-09 2006-08-24 Shin Caterpillar Mitsubishi Ltd パイロット制御装置
JP2006291647A (ja) * 2005-04-14 2006-10-26 Shin Caterpillar Mitsubishi Ltd 作業機械の干渉回避制御装置
WO2012169531A1 (ja) * 2011-06-10 2012-12-13 日立建機株式会社 作業機械
US20160115669A1 (en) * 2014-10-22 2016-04-28 Caterpillar Inc. Boom Assist Management Feature

Cited By (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018145753A (ja) * 2017-03-09 2018-09-20 日立建機株式会社 作業機械の操作支援装置
WO2019053936A1 (ja) * 2017-09-15 2019-03-21 日立建機株式会社 作業機械
JP2019052499A (ja) * 2017-09-15 2019-04-04 日立建機株式会社 作業機械
US11414836B2 (en) 2017-09-15 2022-08-16 Hitachi Construction Machinery Co., Ltd. Work machine
WO2019186840A1 (ja) * 2018-03-28 2019-10-03 日立建機株式会社 作業機械
JPWO2019186840A1 (ja) * 2018-03-28 2020-04-30 日立建機株式会社 作業機械
US11149404B2 (en) 2018-03-28 2021-10-19 Hitachi Construction Machinery Co., Ltd. Work machine
KR20210116569A (ko) * 2019-09-26 2021-09-27 히다치 겡키 가부시키 가이샤 작업 기계
CN113439140A (zh) * 2019-09-26 2021-09-24 日立建机株式会社 作业机械
JP2021055258A (ja) * 2019-09-26 2021-04-08 日立建機株式会社 作業機械
CN113439140B (zh) * 2019-09-26 2022-06-28 日立建机株式会社 作业机械
US11391020B2 (en) 2019-09-26 2022-07-19 Hitachi Construction Machinery Co., Ltd. Work machine
WO2021059584A1 (ja) * 2019-09-26 2021-04-01 日立建機株式会社 作業機械
JP7269143B2 (ja) 2019-09-26 2023-05-08 日立建機株式会社 作業機械
KR102591520B1 (ko) 2019-09-26 2023-10-20 히다치 겡키 가부시키 가이샤 작업 기계
JP2021188669A (ja) * 2020-05-29 2021-12-13 株式会社竹内製作所 作業用車両

Also Published As

Publication number Publication date
CN106256966B (zh) 2018-08-03
CN106256966A (zh) 2016-12-28
EP3106572A1 (en) 2016-12-21
JP6619163B2 (ja) 2019-12-11
US20160369480A1 (en) 2016-12-22
EP3106572B1 (en) 2018-06-06
KR101814657B1 (ko) 2018-01-04
US10024032B2 (en) 2018-07-17
KR20160149139A (ko) 2016-12-27

Similar Documents

Publication Publication Date Title
JP6619163B2 (ja) 作業機械
JP6487872B2 (ja) 作業機械の駆動制御装置
CN110546327B (zh) 作业机械
KR100281009B1 (ko) 2피스부움식 유압셔블의 간섭 방지장치
KR100834799B1 (ko) 선회 제어 장치, 선회 제어 방법, 및 건설 기계
WO2019182128A1 (ja) ショベル
WO2018207267A1 (ja) 作業機械
US5875701A (en) Method and apparatus for controlling an implement of a work machine using linkage angles
JP2003184133A (ja) 油圧作業機の振動抑制装置
JP5835297B2 (ja) 建設機械
WO2020054507A1 (ja) 建設機械
JP3850594B2 (ja) 油圧作業機の油圧制御装置
JPH05195554A (ja) 土工機における油圧アクチュエータ制御装置
KR102054519B1 (ko) 건설기계의 유압시스템
WO2022208694A1 (ja) 作業機械
JP6591370B2 (ja) 建設機械の油圧制御装置
JP3466371B2 (ja) 建設機械の干渉防止装置
JP2012007656A (ja) 作業機械の旋回用油圧制御装置
KR20230143178A (ko) 작업 기계
JP2023144468A (ja) 建設機械の油圧制御装置およびこれを備えた建設機械
JPH05195560A (ja) バックホーの油圧制御装置
JPH05195550A (ja) 土工機における油圧アクチュエータ制御装置
JPH05195553A (ja) 土工機における油圧アクチュエータ制御装置

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180309

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180309

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190109

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190212

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20190412

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190612

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20191114

R150 Certificate of patent or registration of utility model

Ref document number: 6619163

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees