JPH108489A - 建設機械のフロント制御装置 - Google Patents
建設機械のフロント制御装置Info
- Publication number
- JPH108489A JPH108489A JP8166376A JP16637696A JPH108489A JP H108489 A JPH108489 A JP H108489A JP 8166376 A JP8166376 A JP 8166376A JP 16637696 A JP16637696 A JP 16637696A JP H108489 A JPH108489 A JP H108489A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- specific
- signal
- control device
- construction machine
- 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
- 238000010276 construction Methods 0.000 title claims abstract description 37
- 238000004364 calculation method Methods 0.000 claims description 94
- 238000001514 detection method Methods 0.000 claims description 23
- 238000000034 method Methods 0.000 claims description 20
- 238000001914 filtration Methods 0.000 claims description 16
- 238000012937 correction Methods 0.000 claims description 15
- 230000008569 process Effects 0.000 claims description 10
- 238000009412 basement excavation Methods 0.000 description 47
- 238000010586 diagram Methods 0.000 description 31
- 239000003921 oil Substances 0.000 description 23
- 230000007423 decrease Effects 0.000 description 20
- 238000012545 processing Methods 0.000 description 18
- 230000008859 change Effects 0.000 description 17
- 238000006243 chemical reaction Methods 0.000 description 14
- 230000000630 rising effect Effects 0.000 description 12
- 230000000694 effects Effects 0.000 description 11
- 238000013459 approach Methods 0.000 description 8
- 230000004069 differentiation Effects 0.000 description 8
- 230000006870 function Effects 0.000 description 8
- 238000006073 displacement reaction Methods 0.000 description 4
- 230000033001 locomotion Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000002194 synthesizing effect Effects 0.000 description 4
- 238000005259 measurement Methods 0.000 description 3
- 230000001934 delay Effects 0.000 description 2
- 230000002265 prevention Effects 0.000 description 2
- 238000013139 quantization Methods 0.000 description 2
- 230000035939 shock Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000005553 drilling Methods 0.000 description 1
- 239000010720 hydraulic oil Substances 0.000 description 1
- 230000009545 invasion Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000011144 upstream manufacturing Methods 0.000 description 1
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; 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/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; 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/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
- E02F3/437—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2033—Limiting the movement of frames or implements, e.g. to avoid collision between implements and the cabin
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2285—Pilot-operated systems
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2296—Systems with a variable displacement pump
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Paleontology (AREA)
- Operation Control Of Excavators (AREA)
- Component Parts Of Construction Machinery (AREA)
Abstract
油温など、流量制御弁の流量特性に影響を及ぼす負荷、
油温等のパラメータが変化したとしても、フロント装置
の動作を円滑に制御できるようにする。 【解決手段】フロント装置1Aが動き得る領域を予め設
定しておき、フロント装置が設定領域の外にでないよう
フロント動作を制御する。このとき、制御ユニット9
は、アームシリンダ速度演算部9dにおいて、角度検出
器8bで検出したアームの回動角を座標変換及び微分し
て求めたアームシリンダ速度の低周波成分と、操作レバ
ー装置14bによる流量制御弁15bへの指令値とアー
ムの流量制御弁15bの流量特性により求めたアームシ
リンダ速度の高周波成分との和により、制御用のアーム
シリンダ速度を推定し、この推定した動作速度を用いて
フロント装置の動作を制御する。
Description
装置を備えた建設機械、特にアーム、ブーム、バケット
等の複数のフロント部材からなるフロント装置を備えた
油圧ショベル等の建設機械において、フロント装置の動
き得る領域を制限する領域制限掘削制御、フロント装置
の先端を所定の軌跡に沿って移動させる軌跡制御等、少
なくとも1つの操作レバー装置の信号を補正し、フロン
ト装置の動作を制御する建設機械のフロント制御装置に
関する。
る。油圧ショベルではオペレータがフロント装置を構成
するブーム、アームなどのフロント部材をそれぞれの手
動操作レバーによって操作している。これらフロント部
材はそれぞれが関節部によって連結され回動運動を行う
ものであるため、これらフロント部材を操作して所定の
領域を掘削したり、所定の平面を掘削することは、非常
に困難な作業である。また、掘削範囲を広くとるためフ
ロントにオフセット(第2ブーム)を備えた油圧ショベ
ルや、車幅内で旋回可能な超小旋回形の油圧ショベルが
あるが、このような油圧ショベルでは、姿勢によっては
フロントがキャブに干渉する恐れがある。
のキャブとの干渉を防止するための種々の提案がなされ
ている。
は、侵入不可領域の手前に減速領域を設定し、フロント
装置の一部、例えばバケットが減速領域に侵入すると、
操作レバーの操作信号を小さくしてフロント装置を減速
し、バケットが侵入不可領域の境界に達すると停止する
ようにしている。
号公報では、掘削領域を設定し、フロント装置の一部、
例えばバケットが掘削領域の境界に近づくとバケットの
掘削領域に向かう方向の動きのみを減速し、バケットが
掘削領域の境界に達するとバケットは掘削領域の外には
出ないが掘削領域の境界に沿っては動けるようにしてい
る。具体的には、そのような制御を実現するため、角度
センサ等の位置検出手段からの信号に基づきブーム、ア
ーム等のフロント部材の位置と姿勢を演算し、操作レバ
ー装置からの信号を用い、その位置と姿勢の演算値に基
づき、ブーム、アーム等のフロント部材が操作レバー装
置からの信号により動かされるときの動作速度(例えば
ブームシリンダ、アームシリンダ等の速度)を推定し、
この推定した動作速度を用いて操作レバー装置からの信
号を補正している。
来技術には次のような問題がある。
来技術では、バケットが減速領域に侵入すると、操作レ
バーの信号を小さくしてフロント装置を減速し、バケッ
トが侵入不可領域の境界に達するとフロント装置を停止
させるので、バケットを侵入不可領域の境界上で滑らか
に停止させることができる。
の速度を遅くするとき、バケットの移動方向に係わらず
そのまま速度を遅くしている。このため、侵入不可領域
の境界に沿って掘削をする場合、アームを操作して侵入
不可領域に近づくにつれて侵入不可領域の境界に沿った
方向の掘削速度も遅くなり、その都度、ブームレバーを
操作してバケットを侵入不可領域から離し、掘削速度が
遅くなるのを防止しなければならない。その結果、侵入
不可領域に沿って掘削する場合には、極端に能率が悪く
なる。
に記載の従来技術では、バケットが掘削領域の境界に近
づくとバケットの掘削領域に向かう方向の動きのみを減
速し、バケットが掘削領域の境界に達するとバケットは
掘削領域の外には出ないが掘削領域の境界に沿っては動
けるようにしているので、上記従来技術の欠点を解決
し、領域を制限した掘削を能率良く円滑に行うことがで
きる。
ーム等のフロント部材の動作速度を推定するのに操作レ
バー装置の信号(操作信号)を用い、ブームシリンダ、
アームシリンダ等の速度を推定している。
等のアクチュエータはそれぞれの流量制御弁によって圧
油の供給流量が制御され、速度が制御されるが、流量制
御弁の入力信号(開口面積)に対する供給流量の流量特
性は負荷圧、油温等の影響を受け、一定ではない。例え
ば、同じ入力信号(開口面積)であっても、アクチュエ
ータの負荷圧が増大すると圧油がアクチュエータに行き
難くなり、供給流量が減少し、アクチュエータの速度が
減少する。また、油温が低下すれば、油の粘度が増大
し、同じ入力信号(開口面積)であっても供給流量が減
少し、アクチュエータの速度は減少する。
タの速度を推定している上記従来技術では、負荷圧、油
温等が変化すると流量制御弁の流量特性が変化し、制御
精度が低下したり、制御ゲインの変化による不安定さに
起因してハンチングが生じることがある。また、仮に流
量制御弁の前後に負荷補償弁などが設置されている場合
でも、負荷補償弁の精度や油温の変化の影響は避けられ
ない。
御弁の流量特性に影響を及ぼす負荷、油温等のパラメー
タが変化したとしても、フロント装置の動作を円滑に制
御できる建設機械のフロント制御装置を提供することで
ある。
に回動可能な複数のフロント部材により構成される多関
節型のフロント装置と、前記複数のフロント部材を駆動
する複数の油圧アクチュエータと、前記複数のフロント
部材の動作を指示する複数の操作手段と、前記複数の操
作手段からの信号により駆動され、前記複数の油圧アク
チュエータに供給される圧油の流量を制御する複数の油
圧制御弁とを有する建設機械に備えられ、前記フロント
装置の位置と姿勢に関する状態量を検出する第1検出手
段と;前記第1検出手段からの信号に基づき前記フロン
ト装置の位置と姿勢を演算する第1演算手段と;前記複
数の操作手段のうちの第1の特定の操作手段からの信号
を用い、前記第1演算手段で演算されたフロント装置の
位置と姿勢に基づき、前記第1の特定の操作手段に対応
する第1の特定の油圧アクチュエータにより駆動される
第1の特定のフロント部材の動作速度を推定する第2演
算手段とを備え、この推定した動作速度を用いて前記フ
ロント装置の動作を制御する建設機械のフロント制御装
置において、前記第2演算手段は、前記第1検出手段か
らの信号により前記第1の特定のフロント部材の実測動
作速度の低周波成分を求める第1演算・フィルタ手段
と、前記第1の特定の操作手段からの信号により前記第
1の特定のフロント部材の指令動作速度の高周波成分を
求める第2演算・フィルタ手段と、前記実測動作速度の
低周波成分と前記指令動作速度の高周波成分とを組み合
わせて前記第1の特定のフロント部材の制御用の動作速
度を推定する合成演算手段とを有するものとする。
1の特定のフロント部材の指令動作速度は、対応する流
量制御弁の実際の流量特性が負荷圧、油温等の影響を受
け一定ではないため、定常時でも第1の特定のフロント
部材の実際の速度に正確には一致していないことが多
い。しかし、第1の特定の操作手段の信号の急激な変化
は正確に反映している。
して求めた第1の特定のフロント部材の実測動作速度
は、負荷圧、油温等に影響されずに演算される。ただ
し、第1の特定の操作手段による指令から第1の特定の
フロント部材への出力までに遅れがあるため、第1の特
定の操作手段の信号の急激な変化に対しては信頼性がな
い。また、検出値なのである程度ノイズが含まれること
は避けられない。
手段において、実測して求めた第1の特定のフロント部
材の実測動作速度は、高周波成分は信頼性がないため低
周波成分だけを用い、第1演算・フィルタ手段におい
て、第1の特定の操作手段の信号から求めた第1の特定
のフロント部材の指令動作速度は、実際の流量特性が変
化するため、高周波成分だけを用い、合成演算手段にお
いて、両者を組み合わせて第1の特定のフロント部材の
制御用の動作速度を推定する。これにより、負荷圧や油
温等の変化の影響を受けにくく、信号の遅れや定常誤差
の影響を最小限にした円滑なフロント制御が行える。
前記第1演算・フィルタ手段は、前記第1検出手段から
の信号を微分し前記第1の特定のフロント部材の実測動
作速度を求める手段と、この実測動作速度にローパスフ
ィルタ処理を施す手段とを有し、前記第2演算・フィル
タ手段は、前記第1の特定の操作手段からの信号により
前記第1の特定のフロント部材の指令動作速度を求める
手段と、この指令動作速度にハイパスフィルタ処理を施
す手段とを有する。
算・フィルタ手段の処理機能を実現できる。
前記第1演算・フィルタ手段の実測動作速度を求める手
段は、前記第1の特定の操作手段からの信号により前記
第1検出手段からの信号を取り込むための演算サイクル
数を演算するサイクル数演算手段と、最新の演算サイク
ルを含め、前記演算サイクル数分、前記第1検出手段か
らの信号を保存する記憶手段と、前記演算サイクル数を
n、前記最新の演算サイクルにおける第1検出手段から
の信号をαa、nサイクル前の第1検出手段からの信号
をαa-n、1演算サイクルの周期をT、前記第1の特定
のフロント部材の実測動作速度をΩ1としたとき、 Ω1=(αa−αa-n)/(T×n) の式に従って第1の特定のフロント部材の実測動作速度
を演算する手段とを有する。
は第1検出手段からの信号により実測動作速度Ω1を計
算できる。
くは、前記サイクル数演算手段は、前記第1の特定の操
作手段からの信号が大きくなるにつれて前記演算サイク
ル数が少なくなるよう、当該演算サイクル数nを演算す
るものである。
信号を微分して実測角速度Ω1を算出するとき、その精
度は何サイクル前の第1検出手段からの出力値を用いて
微分するかによって決まるが、操作手段からの信号の大
きさを目安として、この信号が小さい場合は比較的多い
サイクル前の出力値を用いて微分を行い、また信号が大
きい場合には比較的少ないサイクル前の出力値を用いて
微分を行うことにより、精度がほぼ一定に保たれる。
前記第2演算・フィルタ手段のハイパスフィルタ処理を
施す手段は、前記第1の特定の操作手段からの信号が大
きくなるにつれて高くなるようカットオフ周波数を演算
し、このカットオフ周波数を用いて前記指令動作速度に
ハイパスフィルタ処理を施すものである。
応じてカットオフ周波数を決め、指令動作速度にハイパ
スフィルタ処理を施したものを、実測角速度と合成して
制御用の動作速度を推定することにより、操作手段から
の信号の大きさに依存する第1検出手段の立ち上がり時
の検出誤差が補正され、立ち上がり時においても正しい
値に近い動作速度が得られる。
くは、前記第1演算・フィルタ手段のローパスフィルタ
処理を施す手段は、前記第1の特定の操作手段からの信
号が大きくなるにつれて高くなるようカットオフ周波数
を演算し、このカットオフ周波数を用いて前記実測動作
速度にローパスフィルタ処理を施すものである。
くは、前記合成演算手段は、前記指令動作速度の高周波
成分にゲインを掛けた値と前記実測動作速度の低周波成
分との和により上記制御用の動作速度を推定するもので
ある。
慣性の大小に応じて信号の立ち上がりの遅れの補償の程
度を最適に設定できる。例えば、第2の特定のフロント
部材が油圧ショベルのブームであるとき、ブームは慣性
が大きく、立ち上がりの応答が遅いことが予想される
が、指令動作速度の高周波成分に乗じるゲインを比較的
大きくとり(1以上)、第1の特定のフロント部材(例
えばアーム)の動作速度を立ち上がり時において大きく
見積もることにより、ブームの目標速度も立ち上がり時
には大きめに計算され、遅れに対して補償する効果が得
られる。
くは、本発明のフロント制御装置は、前記複数の操作手
段のうちの第2の特定の操作手段に対応する第2の特定
の油圧アクチュエータの負荷を検出する第2検出手段
と;前記第2演算手段により推定された第1の特定のフ
ロント部材の動作速度と前記第2の検出手段で検出した
負荷とを用いて前記第2の特定の操作手段の信号を補正
する信号補正手段と;を更に備える。
第1の特定のフロント部材の動作速度だけでなく、第2
の検出手段で検出した負荷も用いて第2の特定の操作手
段の信号を補正することにより、第2の特定の操作手段
の信号の補正に際して負荷補償が行え、負荷変動の影響
を受けにくい第2の特定のフロント部材の制御が行え
る。
くは、本発明のフロント制御装置は、前記フロント装置
の動き得る領域を設定する領域設定手段と;前記第2演
算手段により推定された第1の特定のフロント部材の動
作速度を用い、前記第1演算手段で演算されたフロント
装置の位置と姿勢に基づき、前記フロント装置の動作速
度を推定する第3演算手段と;前記第2の特定のフロン
ト部材を駆動する第2の特定の油圧アクチュエータの負
荷を検出する第2検出手段と;前記第3演算手段により
推定されたフロント装置の動作速度を用い、前記第1演
算手段で演算されたフロント装置の位置と姿勢に基づ
き、前記フロント装置が前記設定領域内でその境界近傍
にあり、前記第1の特定のフロント部材が前記推定した
動作速度で動かされるときに、前記設定領域の境界に接
近する方向の移動速度を制限するのに必要な第2の特定
のフロント部材の動作速度の制限値を演算する第4演算
手段と;前記第2の特定のフロント部材の動作速度が前
記制限値を超えないよう前記第2の特定のフロント部材
に係わる第2の特定の操作手段からの信号を補正する信
号補正手段;とを更に備え;前記信号補正手段は、前記
第2の特定のフロント部材の動作速度の制限値と前記第
2の検出手段で検出した負荷とから、前記第2の特定の
操作手段からの信号の制限値を演算し、前記第2の特定
の操作手段からの信号がこの制限値を越えないよう当該
信号を補正するものである。
ロント部材の動作速度の制限値を演算し、信号補正手段
で第2の特定の操作手段からの信号を補正することによ
り、設定領域の境界に対して接近する方向のフロント装
置の動きを減速する方向変換制御が行われ、設定領域の
境界に沿ってフロント装置を動かすことができる。この
ため、領域を制限した掘削を能率良く円滑に行うことが
できる。
作手段の信号の補正に際して負荷補償を行うので、負荷
変動の影響を受けにくい第2の特定のフロント部材の制
御が行える。
しくは、前記合成演算手段は、前記実測動作速度の低周
波成分と前記指令動作速度の高周波成分とを加算する手
段である。
しくは、前記第1の特定のフロント部材の実測動作速度
及び指令動作速度は、それぞれ、前記第1の特定の油圧
アクチュエータの速度である。
特定のフロント部材の実測動作速度及び指令動作速度
は、それぞれ、前記第1の特定のフロント部材の角速度
であってもよい。
しくは、前記第1の特定のフロント部材は油圧ショベル
のアームであり、前記第2の特定のフロント部材は油圧
ショベルのブームである。
態を、建設機械のフロント制御として油圧ショベルの領
域制限掘削制御を例にとり、図面を用いて説明する。
10により説明する。
ョベルは、油圧ポンプ2と、この油圧ポンプ2からの圧
油により駆動されるブームシリンダ3a、アームシリン
ダ3b、バケットシリンダ3c、旋回モータ3d及び左
右の走行モータ3e,3fを含む複数の油圧アクチュエ
ータと、これら油圧アクチュエータ3a〜3fのそれぞ
れに対応して設けられた複数の操作レバー装置14a〜
14fと、油圧ポンプ2と複数の油圧アクチュエータ3
a〜3f間に接続され、操作レバー装置14a〜14f
の操作信号によって制御され、油圧アクチュエータ3a
〜3fに供給される圧油の流量を制御する複数の流量制
御弁15a〜15fと、油圧ポンプ2と流量制御弁15
a〜15fの間の圧力が設定値以上になった場合に開く
リリーフ弁6とを有し、これらは油圧ショベルの被駆動
部材を駆動する油圧駆動装置を構成している。
方向にそれぞれ回動するブーム1a、アーム1b及びバ
ケット1cからなる多関節型のフロント装置1Aと、上
部旋回体1d及び下部走行体1eからなる車体1Bとで
構成され、フロント装置1Aのブーム1aの基端は上部
旋回体1dの前部に支持されている。ブーム1a、アー
ム1b、バケット1c、上部旋回体1d及び下部走行体
1eはそれぞれブームシリンダ3a、アームシリンダ3
b、バケットシリンダ3c、旋回モータ3d及び左右の
走行モータ3e,3fによりそれぞれ駆動される被駆動
部材を構成し、それらの動作は上記操作レバー装置14
a〜14fにより指示される。
作信号として電気信号(電圧)を出力する電気レバー方
式であり、流量制御弁15a〜15fは両端に電気油圧
変換手段、例えば比例電磁弁を備えた電磁駆動部30
a,30b〜35a,35bを有し、操作レバー装置1
4a〜14fはオペレータの操作量と操作方向に応じた
電圧を電気信号として対応する流量制御弁15a〜15
fの電磁駆動部30a,30b〜35a,35bへ供給
する。
パスタイプの流量制御弁であり、各流量制御弁のセンタ
ーバイパス通路はセンターバイパスライン242により
直列に接続され、センターバイパスライン242の上流
側は供給ライン243を介して油圧ポンプ2に接続さ
れ、下流側はタンクに接続されている。
よる領域制限掘削制御装置が設けられている。この制御
装置は、予め作業に応じてフロント装置の所定部位、例
えばバケット1cの先端が動き得る掘削領域の設定を指
示する設定器7と、ブーム1a、アーム1b及びバケッ
ト1cのそれぞれの回動支点に設けられ、フロント装置
1Aの位置と姿勢に関する状態量としてそれぞれの回動
角を検出する角度検出器8a,8b,8cと、車体1B
の前後方向の傾斜角を検出する傾斜角検出器8dと、ブ
ームシリンダ3aの上げ方向作動のボトム側の負荷圧力
を検出する圧力検出器70と、操作レバー装置14a〜
14fの操作信号、設定器7の設定信号及び角度検出器
8a,8b,8c、傾斜角検出器8d、圧力検出器70
の検出信号を入力し、バケット1cの先端が動き得る掘
削領域を設定すると共に、領域を制限した掘削制御を行
うための操作信号の補正を行う制御ユニット9とから構
成されている。
上に設けられたスイッチ等の操作手段により設定信号を
制御ユニット9に出力し掘削領域の設定を指示するもの
で、操作パネル上には表示装置等、他の補助手段があっ
てもよい。また、ICカードによる方法、バーコードに
よる方法、レーザによる方法、無線通信による方法等、
他の方法を用いてもよい。
制御ユニット9Aは、フロント姿勢演算部9a、領域設
定演算部9b、バケット先端速度の制限値演算部9c、
アームシリンダ速度演算部9d、アームによるバケット
先端速度演算部9e、ブームによるバケット先端速度の
制限値演算部9f、ブームシリンダ速度の制限値演算部
9g、ブーム指令の制限値演算部9h、ブーム指令の最
大値演算部9j、ブーム用バルブ指令演算部9i、アー
ム用バルブ指令演算部9kの各機能を有している。
8a〜8c及び傾斜角検出器8dで検出したブーム、ア
ーム、バケットの回動角及び車体1Bの前後の傾斜角に
基づきフロント装置1Aの位置と姿勢を演算する。
指示でバケット1cの先端が動き得る掘削領域の設定演
算を行う。その一例を図4を用いて説明する。
ト1cの先端を点Pの位置に動かした後、設定器7から
の指示でそのときのバケット1cの先端位置を計算し、
更に設定器7で指示された傾斜角ζにより制限領域の境
界Lを設定する。
ロント装置1A及び車体1Bの各部寸法が記憶されてお
り、領域設定演算部9bはフロント姿勢演算部9aにて
これらのデータと、角度検出器8a,8b,8cで検出
した回動角及び傾斜角検出器8dで検出した車体1bの
傾斜角を用いて点Pの位置を計算する。このとき、点P
の位置は例えばブーム1aの回動支点を原点としたXY
座標系の座標値として求める。XY座標系は本体1Bに
固定した垂直面内にある直交座標系である。
た傾斜角ζにより制限領域の境界Lの直線式を立て、当
該直線上に原点を持ち当該直線を一軸とする直交座標
系、例えば点Pを原点とするXaYa座標系を立て、X
Y座標系からXaYa座標系への変換データを求める。
は、バケット先端の境界Lからの距離Dに基づき、バケ
ット先端速度の境界Lに垂直な成分の制限値aを計算す
る。これは制御ユニット9の記憶装置に図5に示すよう
な関係を記憶しておき、この関係を読み出して行う。
Lからの距離Dを示し、縦軸はバケット先端速度の境界
Lに垂直な成分の制限値aを示し、横軸の距離D及び縦
軸の速度制限値aはXaYa座標系と同じくそれぞれ設
定領域外から設定領域内に向かう方向を(+)方向とし
ている。この距離Dと制限値aの関係は、バケット先端
が設定領域内にあるときには、その距離Dに比例した
(−)方向の速度をバケット先端速度の境界Lに垂直な
成分の制限値aとし、バケット先端が領域外にあるとき
には、その距離Dに比例した(+)方向の速度をバケッ
ト先端速度の境界Lに垂直な成分の制限値aとするよう
に定められている。したがって、設定領域内では、バケ
ット先端速度の境界Lに垂直な成分が(−)方向で制限
値を越えた場合だけ減速され、設定領域外では、バケッ
ト先端が(+)方向に増速されるようになる。
の距離Dとバケット先端速度の制限値aとの関係は直線
的に比例する関係としたが、これに限らず種々の設定が
可能である。
検出器8bで検出したアームの回動角を座標変換及び微
分して求めたアームシリンダ速度の低周波成分と、操作
レバー装置14bによる流量制御弁15bへの指令値と
アームの流量制御弁15bの流量特性により求めたアー
ムシリンダ速度の高周波成分との和により、制御用のア
ームシリンダ速度を推定する。
行われる演算処理の詳細を示す。図6において、アーム
シリンダ速度演算部9dは、アームシリンダ変位演算部
9d1と、微分演算部9d2と、ローパスフィルタ部9
d3と、流量特性演算部9d4と、ハイパスフィルタ部
9d5と、和算部9d6とからなっている。
度検出器8bにより検出したアーム角度を座標変換して
アームシリンダ変位Xを求める。次に、微分演算部9d
2では、アームシリンダ変位Xを微分してアームシリン
ダ速度V1を求める。次に、ローパスフィルタ部9d3
では、アームシリンダ速度V1の低周波成分V1lを求
める。また、流量特性演算部9d4では、アームの指令
値とアームの流量制御弁15bの既知の流量特性により
アームシリンダ速度V2を求める。次に、ハイパスフィ
ルタ部9d5では、アームシリンダ速度V2の高周波成
分V2hを求める。更に和算部9d6では、これらアー
ムシリンダ速度の低周波成分V1lと高周波成分V2h
の和を求め、ブームの制御に用いるべきアームのシリン
ダ速度を推定する。
bの既知の流量特性から求めたアームシリンダ速度V2
は、流量制御弁15bの実際の流量特性がアームシリン
ダ3bの負荷圧、油温等の影響を受け一定ではないた
め、定常時でもアームシリンダ3bの実際の速度に正確
には一致していないことが多い。しかし、アームの指令
値の急激な変化は正確に反映している。
V1は、アームシリンダ3bの負荷圧、油温等に影響さ
れずに演算される。ただし、操作レバー装置14bによ
る指令からアームへの出力までに遅れがあるため、アー
ムの指令値の急激な変化に対しては信頼性がない。ま
た、検出値であるためある程度ノイズが含まれることは
避けられない。
は、上記のように、実測して求めたアームシリンダ速度
V1は、高周波成分は信頼性がないため低周波成分V1
lだけを用い、流量制御弁15bの既知の流量特性から
求めたアームシリンダ速度V2は、実際の流量特性が変
化するため、高周波成分V2hだけを用い、両者の和に
よりブームの制御に用いるアームシリンダ速度を推定す
る。従って、アームシリンダ3bの負荷圧や油温等の変
化の影響を受けにくく、信号の遅れや定常誤差の影響を
最小限にしたアームシリンダ速度の推定が行える。
では、アームシリンダ速度演算部9dで推定した制御用
のアームシリンダ速度とフロント姿勢演算部9aで求め
たフロント装置1Aの位置と姿勢により制御用のアーム
によるバケット先端速度bを推定する。
算部9fでは、演算部9eで求めたアームによるバケッ
ト先端速度bを領域設定演算部9bで求めた変換データ
を用いてXY座標系からXaYa座標系へ変換し、アー
ムによるバケット先端速度(bx,by)を演算し、演
算部9cで求めたバケット先端速度の境界Lに垂直な成
分の制限値aとそのアームによるバケット先端速度の境
界Lに垂直な成分byにより、ブームによるバケット先
端速度の境界Lに垂直な成分の制限値cを演算する。こ
れを図7を用いて説明する。
演算部9cで求められるバケット先端速度の境界Lに垂
直な成分の制限値aとアームによるバケット先端速度演
算部9eで求められるアームによるバケット先端速度b
の境界Lに垂直な成分byの差(aーby)がブームに
よるバケット先端速度の境界Lに垂直な成分の制限値c
であり、ブームによるバケット先端速度の制限値演算部
9fではc=a−byの式より制限値cを計算する。
設定領域内にある場合、境界上にある場合、設定領域外
にある場合に分けて説明する。
ケット先端速度は、バケット先端の境界Lからの距離D
に比例してバケット先端速度の境界Lに垂直な成分の制
限値aに制限され、これよりブームによるバケット先端
速度の境界Lに垂直な成分はc(=a−by)に制限さ
れ、バケット先端速度bの境界Lに垂直な成分byがこ
れを越えた場合にはcに減速される。
場合には、バケット先端速度の境界Lに垂直な成分の制
限値aは0となり、設定領域外に向かうアームによるバ
ケット先端速度bは速度cのブーム上げによる補正動作
によってキャンセルされ、バケット先端速度の境界Lに
垂直な成分byも0となる。
ト先端速度の境界Lに垂直な成分はバケット先端の境界
Lからの距離Dに比例した上向きの速度aに制限される
ことにより、常に設定領域内に復元するように速度cの
ブーム上げによる補正動作が行われる。
は、ブームによるバケット先端速度の境界Lに垂直な成
分の制限値cとフロント装置1Aの位置と姿勢に基づ
き、上記変換データを用いた座標変換によりブームシリ
ンダ速度の制限値を演算する。
出器70で検出したブームシリンダ3aの負荷圧と、図
8に示す負荷圧を考慮したブームの流量制御弁15aの
流量特性に基づき、演算部9gで求めたブームシリンダ
速度の制限値に対応するブームの指令制限値を求める。
このようにブームの指令制限値に対して負荷補償を行う
ことにより、ブームシリンダ3aの負荷変動の影響を受
けにくいブームの制御が行える。
部9hで求めたブーム指令の制限値と操作レバー装置1
4aの指令値を比較し、大きい方を出力する。ここで、
操作レバー装置14aの指令値はXaYa座標系と同じ
く、設定領域外から設定領域内に向かう方向(ブーム上
げ方向)を(+)方向としている。また、演算部9jで
ブーム指令の制限値と操作レバー装置14aの指令値の
大きい方を出力することは、バケット先端が設定領域内
の場合には制限値cが(−)であることから両者の絶対
値の小さい方を出力することであり、バケット先端が領
域外の場合には制限値cが(+)であることから、両者
の絶対値の大きい方を出力することである。
ム指令の最大値演算部9jから出力された指令値が正の
値の場合には流量制御弁15aのブーム上げ駆動部30
aに対応する電圧を出力し、ブーム下げ駆動部30bに
は0の電圧を出力し、指令値が負の場合には逆にする。
レバー装置14bの指令値を入力し、当該指令値が正の
場合には流量制御弁15bのアームクラウド駆動部31
aに対応する電圧を出力し、アームダンプ駆動部31b
には0の電圧を出力し、指令値が負の場合には逆にす
る。
説明する。作業例として、バケット先端の位置決めを行
おうとしてブーム用操作レバー装置14aの操作レバー
をブーム下げ方向に操作してブームを下げる場合(ブー
ム下げ動作)と、手前方向に掘削しようとしてアーム用
操作レバー装置14bの操作レバーをアームクラウド方
向に操作してアームクラウドする場合(アームクラウド
操作)について説明する。
ーム用操作レバー装置14aの操作レバーをブーム下げ
方向に操作するとその操作レバー装置14aの指令値が
最大値演算部9jに入力される。一方、これと同時に、
演算部9cでは図5に示す関係からケット先端と設定領
域の境界Lからの距離Dに比例したバケット先端速度の
制限値a(<0)が計算され、演算部9fではブームに
よるバケット先端速度の制限値c=a(<0)が計算さ
れ、ブーム指令の制限値演算部9hでは制限値cに応じ
た負のブーム指令の制限値が計算される。このとき、バ
ケット先端が設定領域の境界Lから遠いときは演算部9
hで求めたブーム指令の制限値より操作レバー装置14
aの指令値の方が大きいので、ブーム指令の最大値演算
部9jでは操作レバー装置14aの指令値が選択され、
この指令値は負であるので、バルブ指令演算部9iでは
流量制御弁15aのブーム下げ駆動部30bに対応する
電圧を出力し、ブーム上げ駆動部30aには0の電圧を
出力し、これにより操作レバー装置14aの指令値に応
じてブームが下がって行く。
端が設定領域の境界Lに近づくにつれて演算部9fで計
算されるブームによるバケット先端速度の制限値c=a
(<0)は大きくなり(|a|又|c|は小さくな
り)、演算部9hで求めた対応するブーム指令の制限値
が操作レバー装置14aの指令値よりも大きくなると、
ブーム指令の最大値演算部9jでは当該制限値が選択さ
れ、バルブ指令演算部9iでは制限値cに応じて流量制
御弁15aのブーム下げ駆動部30bに出力する電圧を
徐々に制限する。これにより、設定領域の境界Lに近づ
くにつれてブーム下げ速度が徐々に制限され、バケット
先端が設定領域の境界Lに到達するとブームは停止す
る。したがって、バケット先端の位置決めが簡単に滑ら
かにできる。
フロント装置1Aの速度が極端に大きかったり、急激に
操作レバー装置1aを操作した場合には、油圧回路上の
遅れなど制御上の応答遅れやフロント装置1Aにかかる
慣性力などによりバケット先端が設定領域の境界Lから
はみ出す可能性がある。このようにバケット先端がはみ
出した場合、演算部9cでは図5に示す関係からバケッ
ト先端と設定領域の境界Lからの距離Dに比例したバケ
ット先端速度の制限値a(=c)が正の値として計算さ
れ、バルブ指令演算部9iでは制限値cに応じた電圧を
流量制御弁15aのブーム上げ駆動部30aに出力す
る。これにより、ブームは距離Dに比例した速度で領域
内に復元するように上げ方向に動かされ、バケット先端
が設定領域の境界Lまで戻ると停止する。したがって、
バケット先端の位置決めが更に滑らかに行える。
用操作レバー装置14bの操作レバーをアームクラウド
方向に操作するとその操作レバー装置14bの指令値が
アーム用バルブ指令演算部9kに入力され、流量制御弁
15bのアームクラウド駆動部31aに対応する電圧を
出力し、アームは手前方向に下がるよう動かされる。一
方、これと同時に、角度検出器8bで検出したアームの
回動角と操作レバー装置14bの指令値が演算部9dに
入力されて制御用のアームシリンダ速度が推定演算さ
れ、演算部9eで制御用のアームによるバケット先端速
度bが推定演算される。また、演算部9cでは図5に示
す関係からバケット先端と設定領域の境界Lからの距離
Dに比例したバケット先端速度の制限値a(<0)が計
算され、演算部9fではブームによるバケット先端速度
の制限値c=a−byが計算される。そして、演算部9
gでブームシリンダ速度の制限値を計算した後、演算部
9hでは、ブームシリンダ3aの負荷圧を考慮した流量
制御弁15aの流量特性に基づきブームの指令制限値を
求める。このとき、バケット先端が設定領域の境界Lか
ら遠く、a<by(|a|>|by|)のときは、演算
部9fで計算される制限値cは負の値として計算され、
ブーム指令の最大値演算部9jでは操作レバー装置14
aの指令値(=0)が選択され、バルブ指令演算部9i
では流量制御弁15aのブーム上げ駆動部30a及びブ
ーム下げ駆動部30bに0の電圧を出力する。これによ
り操作レバー装置14bの指令値に応じてアームが手前
方向に動かされる。
れ、バケット先端が設定領域の境界Lに近づくにつれて
演算部9cで計算されるバケット先端速度の制限値aは
大きくなり(|a|は小さくなり)、この制限値aが演
算部9eで計算されるアームによるバケット先端速度b
の境界Lに垂直な成分byよりも大きくなると、演算部
9fで計算されるブームによるバケット先端速度の制限
値c=a−byは正の値となり、ブーム指令の最大値演
算部9jでは演算部9hで計算された制限値が選択さ
れ、バルブ指令演算部9iでは制限値cに応じた電圧を
流量制御弁15aのブーム上げ駆動部30aに出力す
る。これにより、バケット先端速度の境界Lに垂直な成
分がバケット先端と境界Lからの距離Dに比例して徐々
に制限されるように、ブーム上げによる補正動作が行わ
れ、アームによるバケット先端速度の補正されていない
境界Lに平行な成分bxとこの制限値cによる補正され
た速度により、図9に示すような方向変換制御が行わ
れ、設定領域の境界Lに沿った掘削が行える。
ット先端が設定領域の境界Lからはみ出す可能性があ
る。このようにバケット先端がはみ出した場合、演算部
9cでは図5に示す関係からケット先端と設定領域の境
界Lからの距離Dに比例したバケット先端速度の制限値
aが正の値として計算され、演算部9fで計算されるブ
ームによるバケット先端速度の制限値c=a−by(>
0)は制限値aに比例して大きくなり、バルブ指令演算
部9iから流量制御弁15aのブーム上げ駆動部30a
に出力される電圧は制限値cに応じて増大する。これに
より、設定領域外では距離Dに比例したバケット先端速
度で領域内に復元するように、ブーム上げによる補正動
作が行われ、アームによるバケット先端速度の補正され
ていない境界Lに並行な成分bxとこの制限値cにより
補正された速度により、図10に示すように設定領域の
境界Lに沿って徐々に戻りながらの掘削が行える。した
がって、アームをクラウドするだけで滑らかに設定領域
の境界Lに沿った掘削が行える。
ト先端が設定領域内にある場合は、バケット先端速度の
設定領域の境界Lに垂直な成分は、バケット先端の境界
Lからの距離Dに比例して制限値aにより制限されるの
で、ブーム下げ動作ではバケット先端の位置決めが簡単
に滑らかにでき、アームクラウド操作では、設定領域の
境界に沿ってバケット先端を動かすことができ、領域を
制限した掘削を能率良く円滑に行うことができる。
ケット先端の境界Lからの距離Dに比例して制限値aに
よりフロント装置が設定領域に戻るように制御されるの
で、フロント装置を速く動かしたときでも設定領域の境
界に沿ってフロント装置を動かすことができ、領域を制
限した掘削を正確に行うことができる。
換制御で減速されているので、設定領域外への侵入量は
少なくなり、設定領域に戻るときのショックは大幅に緩
和される。このため、フロント装置を速く動かしたとき
でも領域を制限した掘削を滑らかに行うことができ、領
域を制限した掘削を円滑に行うことができる。
度演算部9dでは、角度検出器8bで検出したアームの
回動角を座標変換及び微分して求めたアームシリンダ速
度の低周波成分と、操作レバー装置14bによる流量制
御弁15bへの指令値とアームの流量制御弁15bの流
量特性により求めたアームシリンダ速度の高周波成分と
の和により、制御用のアームシリンダ速度を推定するの
で、アームシリンダ3bの負荷圧、油温等の変化の影響
を受けにくく、信号の遅れや定常誤差の影響を最小限に
した制御用のアームシリンダ速度の推定が行える。
ブームシリンダ3aの負荷圧を考慮した流量制御弁15
aの流量特性に基づきブームの指令制限値を求めるの
で、ブームシリンダ3aの負荷変動の影響を受けにくい
ブームの制御が行える。
を受けにくく、信号の遅れや定常誤差の影響を最小限に
した円滑な領域制限掘削制御が行える。
2により説明する。本実施形態は、操作レバー装置とし
て油圧パイロット方式を用いた油圧ショベルに適用した
ものである。図中、図1に示す部材と同等のものには同
じ符号を付している。
油圧ショベルは、電気方式の操作レバー装置14a〜1
4fの代わりに油圧パイロット方式の操作レバー装置4
a〜4fを備えている。操作レバー装置4a〜4fは、
パイロット圧により対応する流量制御弁5a〜5fを駆
動し、それぞれオペレータにより操作される操作レバー
40a〜40fの操作量と操作方向に応じたパイロット
圧を、パイロットライン44a〜49bを介して、対応
する流量制御弁の油圧駆動部50a〜55bに供給す
る。
よる領域制限掘削制御装置が設けられている。この制御
装置は、第1の実施形態で備えられていたものの他に、
アーム用の操作レバー装置4bのパイロットライン45
a,45bに設けられ、操作レバー装置4bの操作量と
してパイロット圧を検出する圧力検出器61a,61b
と、一次ポート側がパイロットポンプ43に接続され電
気信号に応じてパイロットポンプ43からのパイロット
圧を減圧して出力する比例電磁弁10aと、ブーム用の
操作レバー装置4aのパイロットライン44aと比例電
磁弁10aの二次ポート側に接続され、パイロットライ
ン44a内のパイロット圧と比例電磁弁10aから出力
される制御圧の高圧側を選択し、流量制御弁5aの油圧
駆動部50aに導くシャトル弁12と、ブーム用の操作
レバー装置4aのパイロットライン44bに設置され、
電気信号に応じてパイロットライン44b内のパイロッ
ト圧を減圧して出力する比例電磁弁10bとが備えられ
ている。
第1図の実施形態との制御機能の違いを説明する。
度検出器8bで検出したアームの回動角を座標変換及び
微分して求めたアームシリンダ速度の低周波成分と、操
作レバー装置4bによる流量制御弁5bへの指令値の代
わりに、圧力検出器61a,61bで検出した流量制御
弁5bへの指令値(パイロット圧)とアームの流量制御
弁5の流量特性により求めたアームシリンダ速度の高周
波成分との和により、制御用のアームシリンダ速度を推
定する。
は、圧力検出器70で検出したブームシリンダ3aの負
荷圧と、図8に示すのと同様な負荷圧を考慮したブーム
の流量制御弁5aの流量特性に基づき、演算部9gで求
めたブームシリンダ速度の制限値に対応するブームのパ
イロット圧(指令)制限値を求める。
トル弁12を設けたので、ブーム指令の最大値演算部9
jは必要なくなり、その代わりバルブ指令演算部9Bi
では、ブームパイロット圧の制限値演算部9Bhで得ら
れたパイロット圧の制限値が正の場合には、ブーム上げ
側の比例電磁弁10aに制限値に対応する電圧を出力
し、流量制御弁5aの油圧駆動部50aのパイロット圧
を当該制限値にし、ブーム下げ側の比例電磁弁10bに
0の電圧を出力して流量制御弁5aの油圧駆動部50b
のパイロット圧を0にする。また、制限値が負の場合に
は、ブーム下げ側の流量制御弁の油圧駆動部50bのパ
イロット圧を制限するように制限値に対応する電圧を比
例電磁弁10bに出力し、ブーム上げ側の比例電磁弁1
0aには0の電圧を出力し流量制御弁5aの油圧駆動部
50aのパイロット圧を0にする。
を、第1の実施形態と同様ブーム下げ動作とアームクラ
ウド操作について説明する。
ーム用操作レバー装置4aの操作レバーをブーム下げ方
向に操作するとその操作レバー装置4aの指令値である
パイロット圧がパイロットライン44bを介して流量制
御弁5aのブーム下げ側の油圧駆動部50bに与えられ
る。一方、これと同時に、演算部9cでは図5に示す関
係からバケット先端と設定領域の境界Lからの距離Dに
比例したバケット先端速度の制限値a(<0)が計算さ
れ、演算部9fではブームによるバケット先端速度の制
限値c=a(<0)が計算され、ブームパイロット圧の
制限値演算部9Bhでは制限値cに応じた負のブーム指
令の制限値が計算され、バルブ指令演算部9Biではブ
ーム下げ側の流量制御弁の油圧駆動部50bのパイロッ
ト圧を制限するように制限値に対応する電圧を比例電磁
弁10bに出力し、ブーム上げ側の比例電磁弁10aに
は0の電圧を出力し流量制御弁5aの油圧駆動部50a
のパイロット圧を0にする。このとき、バケット先端が
設定領域の境界Lから遠いときは演算部9Bhで求めた
ブームパイロット圧の制限値の絶対値は大きく、これよ
り操作レバー装置4aのパイロット圧の方が小さいの
で、比例電磁弁10bは操作レバー装置4aのパイロッ
ト圧をそのまま出力し、これにより操作レバー装置4a
のパイロット圧に応じてブームが下がって行く。
端が設定領域の境界Lに近づくにつれて演算部9fで計
算されるブームによるバケット先端速度の制限値c=a
(<0)は大きくなり(|a|又|c|は小さくな
り)、演算部9hで求めた対応するブーム指令の制限値
(<0)の絶対値は小さくなる。そして、この制限値の
絶対値が操作レバー装置4aの指令値よりも小さくな
り、バルブ指令演算部9Biから比例電磁弁10bに出
力される電圧がそれに応じて小さくなると、比例電磁弁
10bは操作レバー装置4aのパイロット圧を減圧して
出力し、流量制御弁5aのブーム下げ側の油圧駆動部5
0bに与えられるパイロット圧を制限値cに応じて徐々
に制限する。これにより、設定領域の境界Lに近づくに
つれてブーム下げ速度が徐々に制限され、バケット先端
が設定領域の境界Lに到達するとブームは停止する。し
たがって、バケット先端の位置決めが簡単に滑らかにで
きる。
らはみ出した場合は、演算部9cでは図5に示す関係か
らケット先端と設定領域の境界Lからの距離Dに比例し
たバケット先端速度の制限値a(=c)が正の値として
計算され、バルブ指令演算部9Biでは制限値cに応じ
た電圧を比例電磁弁10aに出力し、ブーム上げ側の流
量制御弁5aの油圧駆動部50aに制限値aに応じたパ
イロット圧を与える。これにより、ブームは距離Dに比
例した速度で領域内に復元するように上げ方向に動かさ
れ、バケット先端が設定領域の境界Lまで戻ると停止す
る。したがって、バケット先端の位置決めが更に滑らか
に行える。
用操作レバー装置4bの操作レバーをアームクラウド方
向に操作するとその操作レバー装置4bの指令値である
パイロット圧が流量制御弁5bのアームクラウド側の油
圧駆動部51aに与えられ、アームは手前方向に下がる
よう動かされる。一方、これと同時に、操作レバー装置
4bのパイロット圧が圧力検出器61aで検出され、角
度検出器8bで検出したアームの回動角と圧力検出器6
1a出検出したパイロット圧が演算部9Bdに入力され
て制御用のアームシリンダ速度が推定演算され、演算部
9eで制御用のアームによるバケット先端速度bが推定
演算される。また、演算部9cでは図5に示す関係から
ケット先端と設定領域の境界Lからの距離Dに比例した
バケット先端速度の制限値a(<0)が計算され、演算
部9fではブームによるバケット先端速度の制限値c=
a−byが計算される。そして、演算部9gでブームシ
リンダ速度の制限値を計算した後、演算部9Bhでは、
ブームシリンダ3aの負荷圧を考慮した流量制御弁5a
の流量特性に基づきブームの指令制限値を求める。この
とき、バケット先端が設定領域の境界Lから遠く、a<
by(|a|>|by|)のときは、演算部9fで計算
される制限値cは負の値として計算され、バルブ指令演
算部9iではブーム下げ側の流量制御弁の油圧駆動部5
0bのパイロット圧を制限するように制限値に対応する
電圧を比例電磁弁10bに出力し、ブーム上げ側の比例
電磁弁10aには0の電圧を出力し流量制御弁5aの油
圧駆動部50aのパイロット圧を0にする。このとき、
操作レバー装置4aは操作されていないので、流量制御
弁5aの油圧駆動部50bにはパイロット圧は出力され
ない。これにより操作レバー装置4bのパイロット圧に
応じてアームが手前方向に動かされる。
れ、バケット先端が設定領域の境界Lに近づくにつれて
演算部9cで計算されるバケット先端速度の制限値aは
大きくなり(|a|は小さくなり)、この制限値aが演
算部9eで計算されるアームによるバケット先端速度b
の境界Lに垂直な成分byよりも大きくなると、演算部
9fで計算されるブームによるバケット先端速度の制限
値c=a−byは正の値となり、バルブ指令演算部9B
iではブーム上げ側の比例電磁弁10aに制限値に対応
する電圧を出力し、流量制御弁5aの油圧駆動部50a
のパイロット圧を当該制限値にし、ブーム下げ側の比例
電磁弁10bに0の電圧を出力して流量制御弁5aの油
圧駆動部50bのパイロット圧を0にする。これによ
り、バケット先端速度の境界Lに垂直な成分がバケット
先端と境界Lからの距離Dに比例して徐々に制限される
ように、ブーム上げによる補正動作が行われ、アームに
よるバケット先端速度の補正されていない境界Lに平行
な成分bxとこの制限値cによる補正された速度によ
り、図9に示すような方向変換制御が行われ、設定領域
の境界Lに沿った掘削が行える。
はみ出した場合は、演算部9cでは図5に示す関係から
ケット先端と設定領域の境界Lからの距離Dに比例した
バケット先端速度の制限値aが正の値として計算され、
演算部9fで計算されるブームによるバケット先端速度
の制限値c=a−by(>0)は制限値aに比例して大
きくなり、バルブ指令演算部9iからブーム上げ側の比
例電磁弁10aに出力される電圧は制限値cに応じて増
大する。これにより、設定領域外では距離Dに比例した
バケット先端速度で領域内に復元するように、ブーム上
げによる補正動作が行われ、アームによるバケット先端
速度の補正されていない境界Lに並行な成分bxとこの
制限値cにより補正された速度により、図10に示すよ
うに設定領域の境界Lに沿って徐々に戻りながらの掘削
が行える。したがって、アームをクラウドするだけで滑
らかに設定領域の境界Lに沿った掘削が行える。
段として油圧パイロット方式を採用したものにおいて第
1の実施形態と同様の効果が得られる。
により説明する。本実施形態は、第1の実施形態とは異
なる領域制限掘削制御に本発明を適用したものである。
図中、図1に示す部材と同等のものには同じ符号を付し
ている。
削制御装置は、ブームシリンダ3aの上げ方向作動のボ
トム側の負荷圧力を検出する圧力検出器70に加えて、
アームシリンダ3bのアームクラウド方向作動のボトム
側の負荷圧力を検出する圧力検出器71を備え、これら
の検出信号が制御ユニット9Cに入力されている。
掘削制御部とを有し、領域設定部では、設定器7からの
指示でバケット1cの先端が動き得る掘削領域の設定演
算を行う。その一例は第1の実施形態で説明したので、
ここでは説明しない。
御部では図14にフローチャートで示す処理によりフロ
ント装置1Aの動き得る領域を制限する制御を行う。以
下、図14に示すフローチャートにより領域制限掘削制
御部の制御機能を明らかにしつつ、本実施形態の動作を
説明する。
置14a〜14fの操作信号を入力し、手順110にお
いて、角度検出器8a,8b,8cにより検出したブー
ム1a、アーム1b及びバケット1cの回動角を入力す
る。
α、β、γと予め入力してあるフロント装置1Aの各部
寸法とに基づきフロント装置1Aの位置と姿勢の計算が
行われ、フロント装置1Aの所定部位の位置、例えばバ
ケット1cの先端位置を計算する。このときの計算は、
先の領域設定部におけるバケット先端位置の計算と同じ
であり、この場合も、バケット先端の位置はXY座標系
の値として求めた後、XaYa座標系に変換する。
a,8b,8cで検出したブーム、アーム、バケットの
回動角の低周波成分と、操作レバー装置14a,14
b,14cの操作信号によるブーム、アーム、バケット
の角速度の高周波成分とのそれぞれの和により、制御用
のブームシリンダ速度、アームシリンダ速度、バケット
シリンダ速度を推定する。
−1〜130−3により説明する。なお、説明の簡略化
のため、ここではアームの角速度についてのみ説明す
る。
の操作レバー装置14bの操作信号S4bと、予め設定し
ておいた図15に示すような操作信号S4bと何サイクル
前の角度検出器8bの出力値を使用するかの演算サイク
ル数とのテーブルより、アーム用操作信号S4bの大きさ
に応じた演算サイクル数nを求め、何サイクル前の角度
検出器8bの出力値を使用するかを決める。そして、制
御ユニット9の一次記憶メモリ(RAM)に現在値を含
めnサイクル数分の角度検出器の出力値を保存し、以下
の式に従って角度検出器8bのnサイクル前の出力値か
らアームの実測角速度Ω1を演算する。
号の立ち上がりの遅れの影響を排除するため、またノイ
ズを除去するため、実測角速度Ω1に対してローパスフ
ィルタ処理を施す。このとき、フィルタ処理におけるカ
ットオフ周波数は、予め図16に示すような操作信号S
4bとフィルタのカットオフ周波数とのテーブルより、ア
ーム用の操作レバー装置14bの操作信号S4bの大きさ
に応じたカットオフ周波数fLを演算し、このカットオ
フ周波数fLを用いて実測角速度Ω1に対してローパスフ
ィルタ処理を施す。この値をΩ1lとする。
作レバー装置14bの操作信号S4bと、予め設定してお
いた図17に示すような操作信号S4bと流量制御弁15
bによるアームシリンダ速度Vaとのメータリングテー
ブルより、操作信号S4bの大きさに応じたアームシリン
ダ速度Vaを演算する。そして、以下の式に従ってアー
ムシリンダ速度Vaをアームの指令角速度Ω2に変換す
る。
−β−α2−β2)) Sa=√(L4 2+L5 2−2L4L5cos(π−β−α2
−β2)) Sa:アームシリンダ長さ L4:アームシリンダ基部とブーム先端間の距離(図1
8参照) L5:アームシリンダ先端とブーム先端間の距離(図1
8参照) α2:ブーム基部とブーム先端を結ぶ線分とアームシリ
ンダ基部とブー ム先端とを結ぶ線分との
なす角度(図18参照) β:ブーム基部とブーム先端を結ぶ線分とブーム先端と
アーム先端とを結ぶ線分とのなす角度(図18参照) β2:ブーム先端とアームシリンダ先端とを結ぶ線分と
ブーム先端とア ーム先端とを結ぶ線分と
のなす角度(図18参照) 次に、予め設定しておいた図19に示すような操作信号
S4bとフィルタのカットオフ周波数のテーブルより、操
作信号S4bの大きさに応じたカットオフ周波数fHを演
算し、このカットオフ周波数fHを用いて指令角速度Ω2
に対してハイパスフィルタ処理を施す。この値をΩ2hと
する。
角速度の高周波成分Ω2hにゲインkを掛け、そして、手
順130−1において演算された実測角速度の低周波成
分Ω1lとの和を演算することにより制御用のアーム角速
度Ωaを算出する。
るに際して、サイクル数nを図15に示すテーブルから
操作信号S4bの大きさに応じて求める理由を説明する。
アーム角速度を演算する場合、 角度検出器8b…180゜回転で0〜5Vを出力するポ
テンショメータ A/D変換器…0〜5Vを10bit(1024分解能)
で変換 のハードウエアで構成すると、A/D変換した場合の1
digitあたりの角度分解能dθは、 dθ=180/1024=0.176゜/digit …(1) となる。
時間tにおける角度の変化量(差分)をtで割ればよ
い。ここで角速度が40゜/sec、角度演算周期が10ms
ec、角速度演算に用いるサイクル数を5サイクルとする
と、5サイクルの間に検出される角度変化の検出値は、
以下の通りである。
1digitなので、この結果から逆に角速度を演算する
と、 (11digit×0.176゜/digit)/50msec=38.72゜/sec …(3) となり、正しい値40゜/secとは誤差が生じる。この誤
差は(2)式からも分かるように、A/D変換した値は
整数値なので必ず±0.5digit相当の誤差が含まれる
ことに起因する(量子化誤差)。この誤差を小さくする
ためには、角速度演算に用いるサイクル数を増やして、
量子化誤差の影響を減らせば良い。例えば、上の例にお
いてサイクル数を20サイクルにすると、20サイクル
の間に検出される角度検出値は、 (40゜/sec/0.176゜/digit)×(20×10msec)=45 digit …(4) なので、逆に角速度を演算すると、 (45digit×0.176゜/digit)/200msec=39.6゜/sec …(5) となり、(3)式と比べて角速度の演算精度が上がる。
また、A/D変換値がノイズの影響等で±1digit程度
の誤差を生じたとすると、その影響は、サイクル数が5
サイクルの場合、 ((11+1)×0.176゜/digit)/50msec=42.2゜/sec ((11-1)×0.176゜/digit)/50msec=35.2゜/sec …(6 ) となり、+2.2〜−4.8゜/secの誤差となるが、
サイクル数が20サイクルの場合、 ((45+1)×0.176゜/digit)/200msec=40.5゜/sec ((45-1)×0.176゜/digit)/200msec=38.7゜/sec …(7) となり、+0.5〜−1.3゜/secと誤差が5サイク
ルの場合より小さくなる。
に相当)と角速度の演算サイクルの適切値nの関係は以
下のようになる。
予め分かっている訳ではないので、Ωとほぼ比例の関係
にある操作レバー信号S(上記のS4bに相当)をΩの代
わりに用いる。
いので、ある上限nmaxを定める。更に、Ωは、最大値
Ωmaxを取るので、Ωmaxとなる操作信号をSmaxとする
と、図20は図15に示すようになる。
分してアームの実測角速度Ω1を算出するとき、その精
度は何サイクル前の角度検出器からの出力値を用いて微
分するかによって決まるが、操作信号S4bの大きさを目
安として、この信号が小さい場合は比較的多いサイクル
前の出力値を用いて微分を行い、また信号が大きい場合
には比較的少ないサイクル前の出力値を用いて微分を行
うことにより、精度がほぼ一定に保たれる。
ィルタ処理を施すに際して、カットオフ周波数fHを図
19に示すテーブルから操作信号S4bの大きさに応じて
求める理由及びΩ2hにゲインkを掛けるを説明する。
イクルn=20、角度検出周期10msecとすると、アー
ムが動き出してからのアーム角度の変化量は図21のよ
うになる。 1サイクル目:40゜/sec×10msec×
(1/0.176゜/digit)=2digit 2サイクル目:40゜/sec×20msec×(1/0.176゜/digit)=4digit 3サイクル目:40゜/sec×30msec×(1/0.176゜/digit)=6digit 2サイクル目:40゜/sec×40msec×(1/0.176゜/digit)=9digit ・ ・ ・ ・ ・ ・ ・ ・ ・ 更に、上記計算結果から角速度を計算すると、20サイ
クル目までは20サイクル前の角度は0となり、21サ
イクル目に入って初めて20サイクル前の角度が2digi
tと計算されるため、 1サイクル目:(1サイクル目の角度変化−20サイクル前の角度)/200msec ×0.176=1.8゜/sec 2サイクル目:(2サイクル目の角度変化−20サイクル前の角度)/200msec ×0.176=3.5゜/sec 3サイクル目:(3サイクル目の角度変化−20サイクル前の角度)/200msec ×0.176=5.3゜/sec ・ ・ ・ ・ ・ ・ ・ ・ ・ 20サイクル目:(20サイクル目の角度変化−20サイクル前の角度)/200msec ×0.176=39.6゜/sec 21サイクル目:(21サイクル目の角度変化−20サイクル前の角度)/200msec ×0.176=39.6゜/sec ・ ・ ・ ・ ・ ・ ・ ・ ・ となり、図22に示すように演算サイクル20を経過し
てようやく正しい値を計算できるようになる。よって、
演算サイクルが小さい場合(操作信号S4bが大きい場
合)と、大きい場合(操作信号S4bが小さい場合)で
は、各々角速度が図23(a)及び(b)に示すように
演算される。
後の正しい角速度に達するまでの時間(n1又はn2)の
誤差を補正するため、図17に示すような操作レバー信
号S4bとアームシリンダ速度Vaのテーブルを予め求め
ておき、S4bに対応するVaより、指令角速度Ω2を算
出し、この指令角速度Ω2に対してカットオフ周波数fH
を変えてハイパスフィルタ処理を施すと、図24に示す
ような特性となり、図23(a)及び(b)に示す立ち
上がり時の角度検出器の誤差を補うのに都合がよい。
い場合(操作信号S4bが大きい場合)は、図25に示す
ように指令角速度Ω2に対してカットオフ周波数の高い
ハイパスフィルタ処理を施した演算値に適当なゲインk
1を掛けたものを、角速度の実測値Ω1に足し込んでやれ
ば、立ち上がり時においても正しい値に近い角速度が得
られる。
い場合(操作信号S4bが小さい場合)は、図26に示す
ように指令角速度Ω2に対してカットオフ周波数の低い
ハイパスフィルタ処理を施した演算値に適当なゲインk
2を掛けたものを、角速度の実測値に足し込んでやれ
ば、立ち上がり時においても正しい値に近い角速度が得
られる。
速度からブームシリンダの目標速度を演算するものであ
るが、ブームは慣性が大きく、立ち上がりの応答が遅い
ことが予想される。そこで、ブームの応答遅れを補償す
るため、上記ゲインk1,k2を比較的大きくとることに
より、アーム角速度を立ち上がり時において図27に示
すように大きく見積もる。これにより、ブームの目標速
度も立ち上がり時には大きめに計算され、遅れに対して
補償する効果が得られる。これは実質上、微分制御と同
様の効果である。
算された角速度成分のうち低周波成分Ω1lは角度検出器
からの出力を微分した実測値なので、フロント装置にか
かる負荷や油温等に影響されず、精度良く演算される。
また、この精度は何サイクル前の角度検出器からの出力
値を用いて微分するかによって決まるが、上記のように
操作信号S4bの大きさを目安として、この信号が小さい
場合は比較的多いサイクル前の出力値を用いて微分を行
い、また信号が大きい場合には比較的少ないサイクル前
の出力値を用いて微分を行うことにより、精度がほぼ一
定に保たれる。
て、この信号が小さい場合は比較的低いカットオフ周波
数でフィルタ処理を行い、また信号が大きい場合には比
較的高いカットオフ周波数でフィルタ処理を行い、実測
角速度と合成して制御用の角速度を推定するので、操作
手信号の大きさに依存する角度検出器の立ち上がり時の
検出誤差が補正され、立ち上がり時においても正しい値
に近い角速度が得られる。
るゲインkを適当に選ぶことにより、信号の立ち上がり
遅れの補償の程度を最適に設定することができる。
の角速度を演算する場合も同様であるので、説明は省略
する。
いて演算されたフロント部材の角速度と、フロント装置
1Aの各部寸法を用いてバケット先端の目標速度ベクト
ルVcを演算する。目標速度ベクトルVcは、XY座標
系を用いて計算した後、先に求めたXY座標系からXa
Ya座標系への変換データを用いて目標速度ベクトルV
cをXaYa座標系に変換し、目標速度ベクトルVcの
設定領域の境界に平行な方向のベクトル成分Vcxと垂
直な方向のベクトル成分Vcyを求める。ここで、Xa
Ya座標系での目標速度ベクトルVcのXa座標成分V
cxは目標速度ベクトルVcの設定領域の境界に平行な
方向のベクトル成分となり、Ya座標成分Vcyは目標
速度ベクトルVcの設定領域の境界に垂直な方向のベク
トル成分となる。
先端が上記のように設定した図28に示すような設定領
域内の境界近傍の領域である減速領域にある場合にある
か否かを判定し、減速領域にある場合には手順160に
進みフロント装置1Aの減速を行うよう目標速度ベクト
ルVcを補正し、減速領域にない時には手順170に進
む。
先端が上記のように設定した図28に示すような設定領
域外にある場合か否かを判定し、設定領域外にある場合
には手順180に進み、バケット1cの先端が設定領域
に戻るように目標速度ベクトルVcを補正し、設定領域
外にないときには手順185に進む。
71により検出したブームシリンダ3a及びアームシリ
ンダ3bの負荷圧を入力する。
0,71で検出したブームシリンダ3a及びアームシリ
ンダ3bのそれぞれの負荷圧と、図8に示したのと同様
な負荷圧を考慮した流量制御弁15a,15bの流量特
性に基づき、手順160または180で得た補正後の目
標速度ベクトルVcに対応するフロント部材の角速度を
求め、更に流量制御弁5a〜5cの操作信号を計算す
る。これらは、手順130における角速度の計算及び手
順140における目標速度ベクトルVcの計算の逆演算
である。このようにブーム及びアームの流量制御弁の操
作信号に対して負荷補償を行うことにより、負荷変動の
影響を受けにくいブーム及びアームの制御が行える。
力した操作信号または手順190で計算した操作信号を
出力し、はじめに戻る。
るか否かの判定及び手順160における減速領域での操
作信号の補正について、図29及び図30を用いて説明
する。
示すような設定領域内における設定領域の境界からバケ
ット1cの先端までの距離D1と減速ベクトル係数hと
の関係が記憶されている。この距離D1と係数hとの関
係は、距離D1が距離Ya1よりも大きいときはh=0で
あり、D1がYa1よりも小さくなると、距離D1が減
少するにしたがって減速ベクトル係数hが増大し、距離
D1=0でh=1となるように設定されている。ここ
で、設定領域の境界から距離Ya1の範囲が減速領域に相
当する。手順150では、前述したXY座標系からXa
Ya座標系への変換データを用いてフロント先端の位置
をXaYa座標系に変換し、そのYa座標値を距離D1
として求め、この距離D1(Ya座標値)が距離Ya1よ
り小さくなると減速領域に進入したと判定する。
したバケット1cの先端の目標速度ベクトルVcの設定
領域の境界に接近する方向のベクトル成分である設定領
域の境界に対し垂直方向のベクトル成分、すなわちXa
Ya座標系におけるYa座標の成分Vcyを減じるよう
に目標速度ベクトルVcを補正する。具体的には、記憶
装置に記憶した図29に示す関係からそのときの設定領
域の境界とバケット1cの先端との距離D1に対応する
減速ベクトル係数hを計算し、この減速ベクトル係数h
を目標速度ベクトルVcのYa座標の成分(垂直方向の
ベクトル成分)Vcyに乗じ、更に−1を乗じて減速ベ
クトルVR(=−h・Vcy)を求め、VcyにVRを加
算する。ここで、減速ベクトルVRはバケット1cの先
端と設定領域の境界との距離D1がYa1より小さくなる
にしたがって大きくなり、D1=0でVR=−Vcyと
なるVcyの逆方向の速度ベクトルである。このため、
減速ベクトルVRを目標速度ベクトルVcの垂直方向の
ベクトル成分Vcyに加算することにより、距離D1が
Ya1より小さくなるにしたがって垂直方向のベクトル成
分Vcyの減少量が大きくなるようベクトル成分Vcy
が減じられ、目標速度ベクトルVcは目標速度ベクトル
Vcaに補正される。
の目標速度ベクトルVcaの通りに減速制御されたとき
の軌跡の一例を図30に示す。目標速度ベクトルVcが
斜め下方に一定であるときには、その平行成分Vcxは
一定となり、垂直成分Vcyはバケット1cの先端が設
定領域の境界に近づくにしたがって(距離D1がYa1よ
り小さくなるにしたがって)小さくなる。補正後の目標
速度ベクトルVcaはその合成であるので、軌跡は図3
0のように設定領域の境界に近づくにつれて平行となる
曲線状となる。また、D1=0でh=1,VR=−Vc
yとなるので、設定領域の境界上での補正後の目標速度
ベクトルVcaは平行成分Vcxに一致する。
かの判定及び手順180における設定領域外での操作信
号の補正について、図31及び図32を用いて説明す
る。
示すような設定領域外における設定領域の境界からバケ
ット1cの先端までの距離D2と復元ベクトルARとの
関係が記憶されている。この距離D2と復元ベクトルA
Rとの関係は、距離D2が減少するにしたがって復元ベ
クトルARが増大するように設定されている。この距離
D2は、手順150で求めたフロント先端位置のYa座
標値の絶対値に相当する。
ント先端位置のYa座標値が負の値になったら設定領域
外に侵入したと判断する。
ント先端位置のYa座標値の絶対値を距離D2として求
め、この距離D2から復元ベクトルARを求め、この復
元ベクトルARを用いて、手順160で計算したバケッ
ト1cの先端の目標速度ベクトルVcの設定領域の境界
に対し垂直方向のベクトル成分、すなわちXaYa座標
系のYa座標の成分Vcyが設定領域の境界に接近する
方向の垂直成分に変わるよう目標速度ベクトルVcを補
正する。
yをキャンセルするようにVcyの逆方向ベクトルAc
yを加算して、平行成分Vcxを抽出する。この補正に
よってバケット1cの先端は設定領域外を更に進もうと
する動作が阻止される。そして次に、復元ベクトルAR
を目標速度ベクトルVc垂直方向のベクトル成分Vcy
に更に加算する。ここで、復元ベクトルARはバケット
1cの先端と設定領域の境界との距離D2が小さくなる
にしたがって小さくなる逆方向の速度ベクトルである。
このため、復元ベクトルARを目標速度ベクトルVcの
垂直方向のベクトル成分Vcyに加算することにより、
距離D2が小さくなるにしたがって垂直方向のベクトル
成分Vcyが小さくなるよう、目標速度ベクトルVcは
目標速度Vcaに補正される。
の目標速度ベクトルVcaの通りに復元制御されたとき
の軌跡の一例を図32に示す。目標速度ベクトルVcが
斜め下方に一定であるときには、その平行成分Vcxは
一定となり、また復元ベクトルARは距離D2に比例す
るので、垂直成分はバケット1cの先端が設定領域の境
界に近づくにしたがって(距離D2が小さくなるにした
がって)小さくなる。補正後の目標速度ベクトルVca
はその合成であるので、軌跡は図32のように設定領域
の境界に近づくにつれて平行となる曲線状となる。
先端が設定領域内にある場合は、バケット先端速度の設
定領域の境界に垂直な成分は、バケット先端の境界から
の距離D1に応じて制限されるので、ブーム下げ動作で
はバケット先端の位置決めが簡単に滑らかにでき、アー
ムクラウド操作では、設定領域の境界に沿ってバケット
先端を動かすことができ、領域を制限した掘削を能率良
く円滑に行うことができる。
ケット先端の境界からの距離D2に応じてフロント装置
が設定領域に戻るように制御されるので、フロント装置
を速く動かしたときでも設定領域の境界に沿ってフロン
ト装置を動かすことができ、領域を制限した掘削を正確
に行うことができる。
御(方向変換制御)で減速されているので、設定領域外
への侵入量は少なくなり、設定領域に戻るときのショッ
クは大幅に緩和される。このため、フロント装置を速く
動かしたときでも領域を制限した掘削を滑らかに行うこ
とができ、領域を制限した掘削を円滑に行うことができ
る。
御用の角速度を求める際、角度検出器からの出力を微分
した実測角速度の低周波成分と、操作レバー信号よりメ
ータリングテーブルを用いて求めた指令角速度の高周波
成分との和によりフロント部材の角速度を推定するの
で、フロントにかかる負荷や油温等の変化に影響され
ず、かつフロント動き出し時の演算上の遅れが補償さ
れ、精度の高い制御が可能となる。
出器からの出力を微分した実測値の低周波成分Ω1lは、
何サイクル前の角度検出器からの出力値を用いて微分す
るかによって精度が決まるが、上記のように操作信号S
4bの大きさを目安として、この信号が小さい場合は比較
的多いサイクル前の出力値を用いて微分を行い、また信
号が大きい場合には比較的少ないサイクル前の出力値を
用いて微分を行うことにより、精度がほぼ一定に保たれ
る。更に、操作信号S4bの大きさを目安として、この信
号が小さい場合は比較的低いカットオフ周波数でフィル
タ処理を行い、また信号が大きい場合には比較的高いカ
ットオフ周波数でフィルタ処理を行うことにより、フィ
ルタ処理の精度も一定に保たれる。
るゲインkを適当に選ぶことにより、信号の立ち上がり
遅れの補償の程度を最適に設定することができる。
か説明したが、本発明はこれに限定されず、種々の変形
が可能である。
制御を行うための設定領域の境界Lに対する距離Dとし
てバケットの先端について述べたが、簡易的に実施する
ならばアーム先端ピンからの距離をとってもよい。ま
た、フロント装置との干渉を防止し安全性を図るために
領域を設定する場合は、その干渉が起こり得る他の部位
であってもよい。
ドセンタタイプの流量制御弁を有するクローズドセンタ
システムとしたが、オープンセンタータイプの流量制御
弁を用いたオープンセンターシステムであってもよい。
領域制限掘削制御の例を示したが、フロントと周囲物体
との干渉を防止する干渉防止制御、フロントとキャブと
の干渉を防止する干渉防止制御等のその他のフロント制
御に本発明を適用しても良い。
制御弁の流量特性に影響を及ぼす負荷、油温等のパラメ
ータが変化したとしても、制御精度を低下させずにまた
ハンチングを生じることなくフロント装置の動作を円滑
に制御できる。
ント制御装置(領域制限掘削制御装置)をその油圧駆動
装置と共に示す図である。
図である。
である。
域の設定方法を示す図である。
領域の境界からの距離との関係を示す図である。
ロック図である。
領域の境界上にある場合と、設定領域外にある場合のブ
ームによるバケット先端速度の補正動作の違いを示す図
である。
ブームの流量制御弁の流量特性を示す図である。
作軌跡の一例を示す図である。
動作軌跡の一例を示す図である。
ロント制御装置(領域制限掘削制御装置)をその油圧駆
動装置と共に示す図である。
ロント制御装置(領域制限掘削制御装置)をその油圧駆
動装置と共に示す図である。
トである。
までの角度検出器の出力値を使用するかの演算サイクル
数との関係を示す図である。
カットオフ周波数との関係を示す図である。
を示す図である。
算するのに用いる諸寸法を示す図である。
カットオフ周波数の関係を示す図である。
適切値nとの関係を示す図である。
量を示す図である。
を示す図である。
の計算される角速度の違いを示す図である。
ハイパスフィルタ処理を施した場合の特性を示す図であ
る。
程を示す図である。
程を示す図である。
令角速度に1以上のゲインkを掛けることにより得られ
る効果を示す図である。
速度ベクトルの補正方法を示す図である。
減速ベクトルとの関係を示す図である。
ときの軌跡の一例を示す図である。
復元ベクトルとの関係を示す図である。
ときの軌跡の一例を示す図である。
Claims (13)
- 【請求項1】上下方向に回動可能な複数のフロント部材
により構成される多関節型のフロント装置と、前記複数
のフロント部材を駆動する複数の油圧アクチュエータ
と、前記複数のフロント部材の動作を指示する複数の操
作手段と、前記複数の操作手段からの信号により駆動さ
れ、前記複数の油圧アクチュエータに供給される圧油の
流量を制御する複数の油圧制御弁とを有する建設機械に
備えられ、前記フロント装置の位置と姿勢に関する状態
量を検出する第1検出手段と;前記第1検出手段からの
信号に基づき前記フロント装置の位置と姿勢を演算する
第1演算手段と;前記複数の操作手段のうちの第1の特
定の操作手段からの信号を用い、前記第1演算手段で演
算されたフロント装置の位置と姿勢に基づき、前記第1
の特定の操作手段に対応する第1の特定の油圧アクチュ
エータにより駆動される第1の特定のフロント部材の動
作速度を推定する第2演算手段とを備え、この推定した
動作速度を用いて前記フロント装置の動作を制御する建
設機械のフロント制御装置において、 前記第2演算手段は、前記第1検出手段からの信号によ
り前記第1の特定のフロント部材の実測動作速度の低周
波成分を求める第1演算・フィルタ手段と、前記第1の
特定の操作手段からの信号により前記第1の特定のフロ
ント部材の指令動作速度の高周波成分を求める第2演算
・フィルタ手段と、前記実測動作速度の低周波成分と前
記指令動作速度の高周波成分とを組み合わせて前記第1
の特定のフロント部材の上記制御用の動作速度を推定す
る合成演算手段とを有することを特徴とする建設機械の
フロント制御装置。 - 【請求項2】請求項1記載の建設機械のフロント制御装
置において、前記第1演算・フィルタ手段は、前記第1
検出手段からの信号を微分し前記第1の特定のフロント
部材の実測動作速度を求める手段と、この実測動作速度
にローパスフィルタ処理を施す手段とを有し、前記第2
演算・フィルタ手段は、前記第1の特定の操作手段から
の信号により前記第1の特定のフロント部材の指令動作
速度を求める手段と、この指令動作速度にハイパスフィ
ルタ処理を施す手段とを有することを特徴とする建設機
械のフロント制御装置。 - 【請求項3】請求項2記載の建設機械のフロント制御装
置において、前記第1演算・フィルタ手段の実測動作速
度を求める手段は、前記第1の特定の操作手段からの信
号により前記第1検出手段からの信号を取り込むための
演算サイクル数を演算するサイクル数演算手段と、最新
の演算サイクルを含め、前記演算サイクル数分、前記第
1検出手段からの信号を保存する記憶手段と、前記演算
サイクル数をn、前記最新の演算サイクルにおける第1
検出手段からの信号をαa、nサイクル前の第1検出手
段からの信号をαa-n、1演算サイクルの周期をT、前
記第1の特定のフロント部材の実測動作速度をΩ1とし
たとき、 Ω1=(αa−αa-n)/(T×n) の式に従って第1の特定のフロント部材の実測動作速度
を演算する手段とを有することを特徴とする建設機械の
フロント制御装置。 - 【請求項4】請求項3記載の建設機械のフロント制御装
置において、前記サイクル数演算手段は、前記第1の特
定の操作手段からの信号が大きくなるにつれて前記演算
サイクル数が少なくなるよう、当該演算サイクル数nを
演算するものであることを特徴とする建設機械のフロン
ト制御装置。 - 【請求項5】請求項4記載の建設機械のフロント制御装
置において、前記第2演算・フィルタ手段のハイパスフ
ィルタ処理を施す手段は、前記第1の特定の操作手段か
らの信号が大きくなるにつれて高くなるようカットオフ
周波数を演算し、このカットオフ周波数を用いて前記指
令動作速度にハイパスフィルタ処理を施すものであるこ
とを特徴とする建設機械のフロント制御装置。 - 【請求項6】請求項4記載の建設機械のフロント制御装
置において、前記第1演算・フィルタ手段のローパスフ
ィルタ処理を施す手段は、前記第1の特定の操作手段か
らの信号が大きくなるにつれて高くなるようカットオフ
周波数を演算し、このカットオフ周波数を用いて前記実
測動作速度にローパスフィルタ処理を施すものであるこ
とを特徴とする建設機械のフロント制御装置。 - 【請求項7】請求項1記載の建設機械のフロント制御装
置において、前記合成演算手段は、前記指令動作速度の
高周波成分にゲインを掛けた値と前記実測動作速度の低
周波成分との和により上記制御用の動作速度を推定する
ものであることを特徴とする建設機械のフロント制御装
置。 - 【請求項8】請求項1記載の建設機械のフロント制御装
置において、 前記複数の操作手段のうちの第2の特定の操作手段に対
応する第2の特定の油圧アクチュエータの負荷を検出す
る第2検出手段と;前記第2演算手段により推定された
第1の特定のフロント部材の動作速度と前記第2の検出
手段で検出した負荷とを用いて、前記第2の特定の操作
手段の信号を補正する信号補正手段と;を更に備えるこ
とを特徴とする建設機械のフロント制御装置。 - 【請求項9】請求項1記載の建設機械のフロント制御装
置において、 前記フロント装置の動き得る領域を設定する領域設定手
段と;前記第2演算手段により推定された第1の特定の
フロント部材の動作速度を用い、前記第1演算手段で演
算されたフロント装置の位置と姿勢に基づき、前記フロ
ント装置の動作速度を推定する第3演算手段と;前記第
2の特定のフロント部材を駆動する第2の特定の油圧ア
クチュエータの負荷を検出する第2検出手段と;前記第
3演算手段により推定されたフロント装置の動作速度を
用い、前記第1演算手段で演算されたフロント装置の位
置と姿勢に基づき、前記フロント装置が前記設定領域内
でその境界近傍にあり、前記第1の特定のフロント部材
が前記推定した動作速度で動かされるときに、前記設定
領域の境界に接近する方向の移動速度を制限するのに必
要な第2の特定のフロント部材の動作速度の制限値を演
算する第4演算手段と;前記第2の特定のフロント部材
の動作速度が前記制限値を超えないよう前記第2の特定
のフロント部材に係わる第2の特定の操作手段からの信
号を補正する信号補正手段;とを更に備え;前記信号補
正手段は、前記第2の特定のフロント部材の動作速度の
制限値と前記第2の検出手段で検出した負荷とから、前
記第2の特定の操作手段からの信号の制限値を演算し、
前記第2の特定の操作手段からの信号がこの制限値を越
えないよう当該信号を補正するものであることを特徴と
する建設機械のフロント制御装置。 - 【請求項10】請求項1記載の建設機械のフロント制御
装置において、前記合成演算手段は、前記実測動作速度
の低周波成分と前記指令動作速度の高周波成分とを加算
する手段であることを特徴とする建設機械のフロント制
御装置。 - 【請求項11】請求項1記載の建設機械のフロント制御
装置において、前記第1の特定のフロント部材の実測動
作速度及び指令動作速度は、それぞれ、前記第1の特定
の油圧アクチュエータの速度であることを特徴とする建
設機械のフロント制御装置。 - 【請求項12】請求項1記載の建設機械のフロント制御
装置において、前記第1の特定のフロント部材の実測動
作速度及び指令動作速度は、それぞれ、前記第1の特定
のフロント部材の角速度であることを特徴とする建設機
械のフロント制御装置。 - 【請求項13】請求項1記載の建設機械のフロント制御
装置において、前記第1の特定のフロント部材は油圧シ
ョベルのアームであり、前記第2の特定のフロント部材
は油圧ショベルのブームであることを特徴とする建設機
械のフロント制御装置。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP16637696A JP3306301B2 (ja) | 1996-06-26 | 1996-06-26 | 建設機械のフロント制御装置 |
EP97110137A EP0816573A3 (en) | 1996-06-26 | 1997-06-20 | Front control system for construction machine |
US08/880,506 US5968104A (en) | 1996-06-26 | 1997-06-23 | Front control system for construction machine |
CN97113938A CN1069721C (zh) | 1996-06-26 | 1997-06-24 | 建筑机械的前部控制装置 |
KR1019970027019A KR100230691B1 (ko) | 1996-06-26 | 1997-06-25 | 건설기계의 프론트 제어장치 및 기록매체 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP16637696A JP3306301B2 (ja) | 1996-06-26 | 1996-06-26 | 建設機械のフロント制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH108489A true JPH108489A (ja) | 1998-01-13 |
JP3306301B2 JP3306301B2 (ja) | 2002-07-24 |
Family
ID=15830272
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP16637696A Expired - Fee Related JP3306301B2 (ja) | 1996-06-26 | 1996-06-26 | 建設機械のフロント制御装置 |
Country Status (5)
Country | Link |
---|---|
US (1) | US5968104A (ja) |
EP (1) | EP0816573A3 (ja) |
JP (1) | JP3306301B2 (ja) |
KR (1) | KR100230691B1 (ja) |
CN (1) | CN1069721C (ja) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002167794A (ja) * | 2000-12-04 | 2002-06-11 | Hitachi Constr Mach Co Ltd | 油圧ショベルのフロント制御装置 |
JP2014122510A (ja) * | 2012-12-21 | 2014-07-03 | Sumitomo (Shi) Construction Machinery Co Ltd | ショベル及びショベル制御方法 |
KR101509249B1 (ko) * | 2008-10-02 | 2015-04-06 | 고려대학교 산학협력단 | 굴삭기 자동 제어 방법 및 시스템 |
US9605412B2 (en) | 2014-06-04 | 2017-03-28 | Komatsu Ltd. | Construction machine control system, construction machine, and construction machine control method |
JP2018172858A (ja) * | 2017-03-31 | 2018-11-08 | 日立建機株式会社 | 作業機械 |
WO2019043898A1 (ja) * | 2017-08-31 | 2019-03-07 | 株式会社小松製作所 | 作業機械の制御システム及び作業機械の制御方法 |
JP2019060132A (ja) * | 2017-09-26 | 2019-04-18 | 日立建機株式会社 | 作業機械 |
KR20210115009A (ko) * | 2019-09-30 | 2021-09-24 | 히다찌 겐끼 가부시키가이샤 | 작업 기계 |
Families Citing this family (44)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000096601A (ja) * | 1998-09-25 | 2000-04-04 | Komatsu Ltd | 作業機の角度制御方法及びその制御装置 |
US6552279B1 (en) | 2000-09-28 | 2003-04-22 | Caterpillar Inc | Method and apparatus configured to perform viscosity compensation for a payload measurement system |
AU2002331786A1 (en) * | 2001-08-31 | 2003-03-18 | The Board Of Regents Of The University And Community College System, On Behalf Of The University Of | Coordinated joint motion control system |
DE10240180A1 (de) * | 2002-08-27 | 2004-03-11 | Putzmeister Ag | Vorrichtung zur Betätigung eines Knickmasts |
US20040267474A1 (en) * | 2003-06-30 | 2004-12-30 | Drake J. Michael | Method and apparatus for performing temperature compensation for a payload measurement system |
US7480579B2 (en) * | 2003-06-30 | 2009-01-20 | Caterpillar Inc. | Method and apparatus for performing temperature compensation for a payload measurement system |
KR100652876B1 (ko) * | 2005-09-26 | 2006-12-01 | 볼보 컨스트럭션 이키프먼트 홀딩 스웨덴 에이비 | 건설기계의 무선전장 시스템 및 이를 이용한 건설기계메인터넌스 시스템 |
WO2007072357A2 (en) * | 2005-12-20 | 2007-06-28 | Koninklijke Philips Electronics, N.V. | Blended sensor system and method |
US8065060B2 (en) * | 2006-01-18 | 2011-11-22 | The Board Of Regents Of The University And Community College System On Behalf Of The University Of Nevada | Coordinated joint motion control system with position error correction |
US8386133B2 (en) * | 2007-02-21 | 2013-02-26 | Deere & Company | Automated control of boom and attachment for work vehicle |
US7748147B2 (en) * | 2007-04-30 | 2010-07-06 | Deere & Company | Automated control of boom or attachment for work vehicle to a present position |
US7797860B2 (en) * | 2007-04-30 | 2010-09-21 | Deere & Company | Automated control of boom or attachment for work vehicle to a preset position |
US7975410B2 (en) * | 2008-05-30 | 2011-07-12 | Caterpillar Inc. | Adaptive excavation control system having adjustable swing stops |
JP4687784B2 (ja) * | 2008-12-22 | 2011-05-25 | トヨタ自動車株式会社 | 移乗支援装置及びその制御方法 |
JP5161155B2 (ja) * | 2009-06-12 | 2013-03-13 | 株式会社小松製作所 | 作業機械および作業機械の制御方法 |
US8340873B2 (en) * | 2010-01-20 | 2012-12-25 | Caterpillar Trimble Control Technologies, Llc | Machine control and guidance system incorporating a portable digital media device |
DE102010035060A1 (de) * | 2010-08-21 | 2012-02-23 | Robert Bosch Gmbh | Verfahren zum Vorgeben einer Drehzahl einer Antriebsmaschine eines Antriebssystems |
US8527158B2 (en) | 2010-11-18 | 2013-09-03 | Caterpillar Inc. | Control system for a machine |
JP5631799B2 (ja) * | 2011-03-31 | 2014-11-26 | 住友建機株式会社 | 建設機械 |
US9464410B2 (en) | 2011-05-19 | 2016-10-11 | Deere & Company | Collaborative vehicle control using both human operator and automated controller input |
CN102608926B (zh) * | 2012-02-09 | 2014-05-21 | 三一汽车制造有限公司 | 折叠臂架的控制方法和系统、控制器及混凝土布料机械 |
US9556583B2 (en) * | 2012-09-25 | 2017-01-31 | Volvo Construction Equipment Ab | Automatic grading system for construction machine and method for controlling the same |
CN102912817A (zh) * | 2012-11-19 | 2013-02-06 | 中联重科股份有限公司渭南分公司 | 挖掘机及其控制方法和控制装置 |
FI20135085L (fi) * | 2013-01-29 | 2014-07-30 | John Deere Forestry Oy | Menetelmä ja järjestelmä työkoneen puomiston ohjaamiseksi kärkiohjauksella |
KR101729050B1 (ko) * | 2013-04-12 | 2017-05-02 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 건설 기계의 제어 시스템 및 제어 방법 |
US9835181B2 (en) * | 2013-04-22 | 2017-12-05 | Illinois Tool Works Inc. | Systems and methods for detecting a type of hydraulic device |
JP6053714B2 (ja) * | 2014-03-31 | 2016-12-27 | 日立建機株式会社 | 油圧ショベル |
CN104619920B (zh) | 2014-09-10 | 2016-09-28 | 株式会社小松制作所 | 作业车辆 |
DE112014000147B4 (de) | 2014-09-10 | 2021-07-29 | Komatsu Ltd. | Baufahrzeug |
US9834905B2 (en) * | 2015-09-25 | 2017-12-05 | Komatsu Ltd. | Work machine control device, work machine, and work machine control method |
WO2016129708A1 (ja) * | 2016-03-29 | 2016-08-18 | 株式会社小松製作所 | 作業機械の制御装置、作業機械及び作業機械の制御方法 |
CN108884655B (zh) * | 2016-03-30 | 2022-02-11 | 住友建机株式会社 | 施工机械 |
JP6732539B2 (ja) * | 2016-05-26 | 2020-07-29 | 日立建機株式会社 | 作業機械 |
JP6666208B2 (ja) * | 2016-07-06 | 2020-03-13 | 日立建機株式会社 | 作業機械 |
JP6634363B2 (ja) * | 2016-11-16 | 2020-01-22 | 日立建機株式会社 | 作業機械 |
JP7001350B2 (ja) * | 2017-02-20 | 2022-01-19 | 株式会社小松製作所 | 作業車両および作業車両の制御方法 |
JP6684240B2 (ja) * | 2017-03-06 | 2020-04-22 | 日立建機株式会社 | 建設機械 |
US11408150B2 (en) * | 2017-04-27 | 2022-08-09 | Komatsu Ltd. | Control system for work vehicle, method, and work vehicle |
JP6707064B2 (ja) * | 2017-08-24 | 2020-06-10 | 日立建機株式会社 | 油圧式作業機械 |
JP6752186B2 (ja) * | 2017-09-26 | 2020-09-09 | 日立建機株式会社 | 作業機械 |
CN110520575B (zh) * | 2018-03-22 | 2021-11-02 | 日立建机株式会社 | 作业机械 |
US11149404B2 (en) * | 2018-03-28 | 2021-10-19 | Hitachi Construction Machinery Co., Ltd. | Work machine |
JP6841784B2 (ja) * | 2018-03-28 | 2021-03-10 | 日立建機株式会社 | 作業機械 |
JP7227046B2 (ja) * | 2019-03-22 | 2023-02-21 | 日立建機株式会社 | 作業機械 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4260941A (en) * | 1975-10-28 | 1981-04-07 | Unimation, Inc. | Programmable automatic assembly system |
CA1279678C (en) * | 1986-02-18 | 1991-01-29 | James P. Karlen | Industrial robot with servo |
US4894598A (en) * | 1986-11-20 | 1990-01-16 | Staubli International Ag | Digital robot control having an improved pulse width modulator |
US5116186A (en) * | 1988-08-02 | 1992-05-26 | Kabushiki Kaisha Komatsu Seisakusho | Apparatus for controlling hydraulic cylinders of a power shovel |
JPH0794735B2 (ja) * | 1990-09-27 | 1995-10-11 | 株式会社小松製作所 | 掘削作業機の作業領域制御装置 |
JP2966629B2 (ja) * | 1991-03-20 | 1999-10-25 | 日立建機株式会社 | 油圧作業機械における作業装置の振動抑制制御装置 |
JPH06307404A (ja) * | 1993-04-21 | 1994-11-01 | Hitachi Constr Mach Co Ltd | 油圧作業機械における作業装置の振動抑制制御装置 |
US5424623A (en) * | 1993-05-13 | 1995-06-13 | Caterpillar Inc. | Coordinated control for a work implement |
US5845223A (en) * | 1993-07-02 | 1998-12-01 | Samsung Heavy Industry Co., Ltd. | Apparatus and method for controlling actuators of hydraulic construction equipment |
US5835874A (en) * | 1994-04-28 | 1998-11-10 | Hitachi Construction Machinery Co., Ltd. | Region limiting excavation control system for construction machine |
JP2566745B2 (ja) * | 1994-04-29 | 1996-12-25 | 三星重工業株式会社 | 電子制御油圧掘削機の自動平坦作業方法 |
KR0173835B1 (ko) * | 1994-06-01 | 1999-02-18 | 오까다 하지모 | 건설기계의 영역제한 굴삭제어장치 |
US5572809A (en) * | 1995-03-30 | 1996-11-12 | Laser Alignment, Inc. | Control for hydraulically operated construction machine having multiple tandem articulated members |
JP3091667B2 (ja) * | 1995-06-09 | 2000-09-25 | 日立建機株式会社 | 建設機械の領域制限掘削制御装置 |
US5860480A (en) * | 1997-04-08 | 1999-01-19 | Caterpillar Inc. | Method and apparatus for determining pitch and ground speed of an earth moving machines |
-
1996
- 1996-06-26 JP JP16637696A patent/JP3306301B2/ja not_active Expired - Fee Related
-
1997
- 1997-06-20 EP EP97110137A patent/EP0816573A3/en not_active Withdrawn
- 1997-06-23 US US08/880,506 patent/US5968104A/en not_active Expired - Fee Related
- 1997-06-24 CN CN97113938A patent/CN1069721C/zh not_active Expired - Fee Related
- 1997-06-25 KR KR1019970027019A patent/KR100230691B1/ko not_active IP Right Cessation
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002167794A (ja) * | 2000-12-04 | 2002-06-11 | Hitachi Constr Mach Co Ltd | 油圧ショベルのフロント制御装置 |
KR101509249B1 (ko) * | 2008-10-02 | 2015-04-06 | 고려대학교 산학협력단 | 굴삭기 자동 제어 방법 및 시스템 |
JP2014122510A (ja) * | 2012-12-21 | 2014-07-03 | Sumitomo (Shi) Construction Machinery Co Ltd | ショベル及びショベル制御方法 |
US9605412B2 (en) | 2014-06-04 | 2017-03-28 | Komatsu Ltd. | Construction machine control system, construction machine, and construction machine control method |
JP2018172858A (ja) * | 2017-03-31 | 2018-11-08 | 日立建機株式会社 | 作業機械 |
WO2019043898A1 (ja) * | 2017-08-31 | 2019-03-07 | 株式会社小松製作所 | 作業機械の制御システム及び作業機械の制御方法 |
JPWO2019043898A1 (ja) * | 2017-08-31 | 2020-08-06 | 株式会社小松製作所 | 作業機械の制御システム及び作業機械の制御方法 |
US11591768B2 (en) | 2017-08-31 | 2023-02-28 | Komatsu Ltd. | Control system of work machine and method for controlling work machine |
JP2019060132A (ja) * | 2017-09-26 | 2019-04-18 | 日立建機株式会社 | 作業機械 |
KR20210115009A (ko) * | 2019-09-30 | 2021-09-24 | 히다찌 겐끼 가부시키가이샤 | 작업 기계 |
Also Published As
Publication number | Publication date |
---|---|
US5968104A (en) | 1999-10-19 |
CN1172880A (zh) | 1998-02-11 |
CN1069721C (zh) | 2001-08-15 |
JP3306301B2 (ja) | 2002-07-24 |
EP0816573A3 (en) | 1998-07-01 |
EP0816573A2 (en) | 1998-01-07 |
KR100230691B1 (ko) | 1999-11-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3306301B2 (ja) | 建設機械のフロント制御装置 | |
JP3091667B2 (ja) | 建設機械の領域制限掘削制御装置 | |
JP3056254B2 (ja) | 建設機械の領域制限掘削制御装置 | |
JP3112814B2 (ja) | 建設機械の領域制限掘削制御装置 | |
JP3811190B2 (ja) | 建設機械の領域制限掘削制御装置 | |
JP3571142B2 (ja) | 建設機械の軌跡制御装置 | |
US6098322A (en) | Control device of construction machine | |
JP4215944B2 (ja) | 油圧ショベルのフロント制御装置 | |
JP3441886B2 (ja) | 油圧建設機械の自動軌跡制御装置 | |
JP3198249B2 (ja) | 建設機械の干渉防止装置 | |
JP3133919B2 (ja) | 建設機械の領域制限掘削制御装置 | |
JPH11350537A (ja) | 油圧作業機械の制御装置 | |
JP3437348B2 (ja) | 建設機械の軌跡制御装置 | |
JP2000303492A (ja) | 建設機械のフロント制御装置 | |
JP2687169B2 (ja) | 建設機械の法面作業制御装置 | |
JP2000355957A (ja) | 油圧ショベルの領域制限掘削制御装置 | |
JPS5820835A (ja) | 腕式作業機のバケツト角制御装置 | |
JP3217981B2 (ja) | 建設機械の制御装置 | |
JP3497950B2 (ja) | 建設機械の領域制限掘削制御装置 | |
JPH02232430A (ja) | 油圧ショベルの掘削深さ制御装置 | |
JPH10252095A (ja) | 建設機械の制御装置 | |
JP2601865B2 (ja) | 作業機の軌跡制御装置 | |
JP2699097B2 (ja) | 建設機械のバケット刃先深さ制御装置 | |
JPH11350536A (ja) | 油圧作業機械の制御装置 | |
JPH0313377B2 (ja) |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080510 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090510 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090510 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100510 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110510 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110510 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120510 Year of fee payment: 10 |
|
LAPS | Cancellation because of no payment of annual fees |