Nothing Special   »   [go: up one dir, main page]

JP6878226B2 - 作業機械 - Google Patents

作業機械 Download PDF

Info

Publication number
JP6878226B2
JP6878226B2 JP2017179134A JP2017179134A JP6878226B2 JP 6878226 B2 JP6878226 B2 JP 6878226B2 JP 2017179134 A JP2017179134 A JP 2017179134A JP 2017179134 A JP2017179134 A JP 2017179134A JP 6878226 B2 JP6878226 B2 JP 6878226B2
Authority
JP
Japan
Prior art keywords
target surface
work machine
current terrain
bucket
control unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2017179134A
Other languages
English (en)
Other versions
JP2019052515A (ja
Inventor
理優 成川
理優 成川
秀一 森木
秀一 森木
枝村 学
学 枝村
枝穂 泉
泉  枝穂
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
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 JP2017179134A priority Critical patent/JP6878226B2/ja
Priority to US16/631,505 priority patent/US11230824B2/en
Priority to CN201880055230.4A priority patent/CN111051619B/zh
Priority to EP18858018.7A priority patent/EP3686356B1/en
Priority to KR1020207005099A priority patent/KR102399329B1/ko
Priority to PCT/JP2018/024609 priority patent/WO2019058695A1/ja
Publication of JP2019052515A publication Critical patent/JP2019052515A/ja
Application granted granted Critical
Publication of JP6878226B2 publication Critical patent/JP6878226B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • 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
    • 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
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • 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
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/437Control 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
    • 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/2004Control mechanisms, e.g. control levers
    • 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/2025Particular purposes of control systems not otherwise provided for
    • E02F9/2033Limiting the movement of frames or implements, e.g. to avoid collision between implements and the cabin
    • 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/26Indicating devices
    • 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/261Surveying the work-site to be treated
    • 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/261Surveying the work-site to be treated
    • E02F9/262Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller

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)
  • Processing Or Creating Images (AREA)

Description

本発明は作業機械に関する。
油圧ショベルに代表される,作業機(フロント作業機)を備えた作業機械は,オペレータが操作レバーを操作することで,作業機が駆動され,施工対象となる地形を所望の形状に整形する。このような作業の支援を目的とした技術として,マシンガイダンス(Machine Guidance:MG)がある。MGは,最終的に実現したい施工対象面の所望の形状を示す設計面データと,作業機の位置関係を表示することで,オペレータの操作支援を実現する技術である。
たとえば特開2014−101664号公報には,バケット(作業具)を含む作業機と,作業機が取り付けられる掘削機械の表示システムであって,バケットの先端の位置の情報を検出する作業機状態検出部と,設計地形を示す設計面の位置情報及びバケットの外形情報を記憶する記憶部と,バケットの先端の位置の情報とバケットの外形情報に基づいて,バケットの先端を少なくとも含みバケット尻部の外形に沿って予め複数点定められた,位置を計測するための計測基準点のうち,設計面に最も近い計測基準点を求める処理部と,を含む掘削機械の表示システムが開示されている。つまり,設計面とバケットの距離のうち,最短距離を算出している。さらに,この最短距離に基づいて警報を発報したり、警報として音を発報する態様を変更したりする,と記載されている。
特開2014−101664号公報
特開2014−101664号公報では,バケットと設計面の距離が近く現況地形を掘りすぎる可能性(バケットが設計面に衝突する可能性)があることをオペレータに認識させるための警報の発報を設計面とバケットの距離のみに基づいて行っている。そのため,現況地形を掘りすぎる可能性が無い場合でも,当該距離によっては警報が発報される可能性がある。たとえば,現状の施工対象の地形(以下,現況地形と称する)が設計面の下方にある場合,すなわち,現況地形に対して盛土を行う場合には,バケットにより現況地形を掘りすぎる可能性に関する警報は不要となる。また,盛土作業中に不要な警報が頻繁に出力されることは,オペレータに煩わしさを感じさせる。このように,必要な場合のみ提供されることが好ましいという点は,警報のみに該当する問題ではなく,警報及び距離表示を含む現況地形と目標面の位置に関する操作支援情報の通達全般に当て嵌まる問題である。
本発明の目的は,現況地形と目標面の位置に関する操作支援情報を必要な場合にのみ通達できる作業機械を提供することにある。
本願は上記課題を解決する手段を複数含んでいるが,その一例を挙げるならば,多関節型の作業機と,前記作業機を駆動する複数の油圧アクチュエータと,前記油圧アクチュエータの動作を指示する操作装置と,オペレータに操作支援情報を通達するための通達装置と,任意に設定した複数の目標面のうち所定の目標面と前記作業機の距離に基づいて前記操作支援情報を通達するか否かを制御する通達制御部を有する制御装置とを備える作業機械において,前記作業機の作業対象となる現況地形の位置を取得する現況地形取得装置をさらに備え,前記制御装置は,前記現況地形と前記作業機に最も近い目標面の位置と前記作業機に最も近い目標面に前記作業機の動作方向で隣接する目標面の位置とを比較して前記現況地形と前記作業機に最も近い目標面の位置との上下関係および、前記現況地形と前記作業機に最も近い目標面に前記作業機の動作方向で隣接する目標面の位置との上下関係を判定する目標面比較部を備え,前記通達制御部は,前記目標面比較部の判定結果に基づいて前記操作支援情報の内容を変更するものとする。
本発明によれば不要な操作支援情報が通達されることを防止できるので,オペレータが不要な操作支援情報に悩まされることを防止できる。
本発明の実施形態に係る油圧ショベルの構成図。 本発明の実施形態に係る油圧ショベルの制御コントローラを油圧駆動装置と共に示す図。 図2中のフロント制御用油圧ユニット160の詳細図。 図1の油圧ショベルにおける座標系および目標面を示す図。 油圧ショベルの制御コントローラ40のハードウェア構成図。 油圧ショベルの制御コントローラ40の機能ブロック図。 図6中のMG及びMC制御部43の機能ブロック図。 目標面比較部62による現況地形800と目標面700の上下関係の判定方法の説明図。 作業機1Aの可動範囲,作業可能範囲D,作業不可能範囲Fを示す図。 目標面比較部62による現況地形800と目標面700の上下関係の判定に作業機1Aの可動範囲情報を考慮する場合の説明図。 通達制御部374による通達内容の制御フロー図。 ステップSB108に進んだ場合の通達装置53の表示画面の一例。 ステップSB105に進んだ場合の通達装置53の表示画面の一例。 ステップSB102に進んだ場合の通達装置53の表示画面の一例。 ステップSB102に進んだ場合の通達装置53の表示画面の一例。 アクチュエータ制御部81によるブーム上げ制御のフロー図。 通達内容変更フラグが下りている場合の距離Dと制限値ayの関係図。 目標面比較部62における通達内容変更フラグに関するフローチャート。 目標面比較部62におけるMG対象目標面変更フラグに関するフローチャート。 最短目標面と移動先目標面の説明図。 通達内容変更フラグが上がっている場合の距離Dと制限値ayの関係図。 図8の例においてステップSB102に進んだ場合の通達装置53の表示画面の一例。
以下,本発明の実施形態について図面を用いて説明する。なお,以下では,作業機の先端の作業具(アタッチメント)としてバケット10を備える油圧ショベルを例示するが,バケット以外のアタッチメントを備える作業機械で本発明を適用しても構わない。さらに,複数のリンク部材(アタッチメント,アーム,ブーム等)を連結して構成される多関節型の作業機を有するものであれば油圧ショベル以外の作業機械への適用も可能である。
また,本稿では,或る形状を示す用語(例えば,目標面,設計面等)とともに用いられる「上」,「上方」又は「下方」という語の意味に関し,「上」は当該或る形状の「表面」を意味し,「上方」は当該或る形状の「表面より高い位置」を意味し,「下方」は当該或る形状の「表面より低い位置」を意味することとする。また,以下の説明では,同一の構成要素が複数存在する場合,符号(数字)の末尾にアルファベットを付すことがあるが,当該アルファベットを省略して当該複数の構成要素をまとめて表記することがある。例えば,3つのポンプ300a,300b,300cが存在するとき,これらをまとめてポンプ300と表記することがある。
<油圧ショベルの全体構成>
図1は本発明の実施形態に係る油圧ショベルの構成図であり,図2は本発明の実施形態に係る油圧ショベルの制御コントローラを油圧駆動装置と共に示す図であり,図3は図2中のフロント制御用油圧ユニット160の詳細図である。
図1において,油圧ショベル1は,多関節型のフロント作業機1Aと,車体1Bで構成されている。車体1Bは,左右の走行油圧モータ3a,3b(油圧モータ3aは図2を参照)により走行する下部走行体11と,下部走行体11の上に取り付けられ,旋回油圧モータ4により旋回する上部旋回体12とからなる。
フロント作業機1Aは,垂直方向にそれぞれ回動する複数の被駆動部材(ブーム8,アーム9及びバケット10)を連結して構成されている。ブーム8の基端は上部旋回体12の前部においてブームピンを介して回動可能に支持されている。ブーム8の先端にはアームピンを介してアーム9が回動可能に連結されており,アーム9の先端にはバケットピンを介してバケット10が回動可能に連結されている。ブーム8はブームシリンダ5によって駆動され,アーム9はアームシリンダ6によって駆動され,バケット10はバケットシリンダ7によって駆動される。
ブーム8,アーム9,バケット10の回動角度α,β,γ(図5参照)を測定可能なように,ブームピンにブーム角度センサ30,アームピンにアーム角度センサ31,バケットリンク13にバケット角度センサ32が取付けられ,上部旋回体12には基準面(例えば水平面)に対する上部旋回体12(車体1B)の傾斜角θ(図5参照)を検出する車体傾斜角センサ33が取付けられている。なお,角度センサ30,31,32はそれぞれ基準面(例えば水平面)に対する角度センサに代替可能である。
上部旋回体12に設けられた運転室内には,走行右レバー23a(図1)を有し走行右油圧モータ3a(下部走行体11)を操作するための操作装置47a(図2)と,走行左レバー23b(図1)を有し走行左油圧モータ3b(下部走行体11)を操作するための操作装置47b(図2)と,操作右レバー1a(図1)を共有しブームシリンダ5(ブーム8)及びバケットシリンダ7(バケット10)を操作するための操作装置45a,46a(図2)と,操作左レバー1b(図1)を共有しアームシリンダ6(アーム9)及び旋回油圧モータ4(上部旋回体12)を操作するための操作装置45b,46b(図2)が設置されている。以下では,走行右レバー23a,走行左レバー23b,操作右レバー1aおよび操作左レバー1bを操作レバー1,23と総称することがある。
上部旋回体12に搭載された原動機であるエンジン18は,油圧ポンプ2とパイロットポンプ48を駆動する。油圧ポンプ2はレギュレータ2aによって容量が制御される可変容量型ポンプであり,パイロットポンプ48は固定容量型ポンプである。本実施形態においては,図2に示すように,パイロットライン144,145,146,147,148,149の途中にシャトルブロック162が設けられている。操作装置45,46,47から出力された油圧信号が,このシャトルブロック162を介してレギュレータ2aにも入力される。シャトルブロック162の詳細構成は省略するが,油圧信号がシャトルブロック162を介してレギュレータ2aに入力されており,油圧ポンプ2の吐出流量が当該油圧信号に応じて制御される。
パイロットポンプ48の吐出配管であるポンプライン170はロック弁39を通った後,複数に分岐して操作装置45,46,47,フロント制御用油圧ユニット160内の各弁に接続している。ロック弁39は本例では電磁切換弁であり,その電磁駆動部は上部旋回体12の運転室に配置されたゲートロックレバー(不図示)の位置検出器と電気的に接続している。ゲートロックレバーのポジションは位置検出器で検出され,その位置検出器からロック弁39に対してゲートロックレバーのポジションに応じた信号が入力される。ゲートロックレバーのポジションがロック位置にあればロック弁39が閉じてポンプライン170が遮断され,ロック解除位置にあればロック弁39が開いてポンプライン170が開通する。つまり,ポンプライン170が遮断された状態では操作装置45,46,47による操作が無効化され,旋回,掘削等の動作が禁止される。
操作装置45,46,47は,油圧パイロット方式であり,パイロットポンプ48から吐出される圧油をもとに,それぞれオペレータにより操作される操作レバー1,23の操作量(例えば,レバーストローク)と操作方向に応じたパイロット圧(操作圧と称することがある)を発生する。このように発生したパイロット圧は,コントロールバルブユニット20内の対応する流量制御弁15a〜15f(図2または図3参照)の油圧駆動部150a〜155bにパイロットライン144a〜149b(図3参照)を介して供給され,これら流量制御弁15a〜15fを駆動する制御信号として利用される。
油圧ポンプ2から吐出された圧油は,流量制御弁15a,15b,15c,15d,15e,15f(図3参照)を介して走行右油圧モータ3a,走行左油圧モータ3b,旋回油圧モータ4,ブームシリンダ5,アームシリンダ6,バケットシリンダ7,に供給される。供給された圧油によってブームシリンダ5,アームシリンダ6,バケットシリンダ7が伸縮することで,ブーム8,アーム9,バケット10がそれぞれ回動し,バケット10の位置及び姿勢が変化する。また,供給された圧油によって旋回油圧モータ4が回転することで,下部走行体11に対して上部旋回体12が旋回する。そして,供給された圧油によって走行右油圧モータ3a,走行左油圧モータ3bが回転することで,下部走行体11が走行する。
作業機1Aの姿勢は図4のショベル基準座標に基づいて定義できる。図4のショベル基準座標は,上部旋回体12に設定された座標であり,ブーム8の基底部を原点とし,上部旋回体12における鉛直方向にZ軸,水平方向にX軸を設定した。X軸に対するブーム8の傾斜角をブーム角α,ブームに対するアーム9の傾斜角をアーム角β,アームに対するバケット爪先の傾斜角をバケット角γとした。水平面(基準面)に対する車体1B(上部旋回体12)の傾斜角を傾斜角θとした。ブーム角αはブーム角度センサ30により,アーム角βはアーム角度センサ31により,バケット角γはバケット角度センサ32により,傾斜角θは車体傾斜角センサ33により検出される。ブーム角αは,ブーム8を最大(最高)まで上げたとき(ブームシリンダ5が上げ方向のストロークエンドのとき,つまりブームシリンダ長が最長のとき)に最少となり,ブーム8を最小(最低)まで下げたとき(ブームシリンダ5が下げ方向のストロークエンドのとき,つまりブームシリンダ長が最短のとき)に最大となる。アーム角βは,アームシリンダ長が最短のときに最小となり,アームシリンダ長が最長のときに最大となる。バケット角γは,バケットシリンダ長が最短のとき(図4のとき)に最小となり,バケットシリンダ長が最長のときに最大となる。このとき,ブーム8の基底部からアーム9との接続部までの長さをL1,アーム9とブーム8の接続部からアーム9とバケット10の接続部までの長さをL2,アーム9とバケット10の接続部からバケット10の先端部までの長さをL3とすると,ショベル基準座標におけるバケット10の先端位置は,XbkをX方向位置,ZbkをZ方向位置として,以下の式で表すことができる。
Figure 0006878226
Figure 0006878226
また,油圧ショベル1は,上部旋回体12に一対のGNSS(Global Navigation Sattelite System)アンテナ14A,14Bを備えている。GNSSアンテナ14からの情報に基づき,グローバル座標系における油圧ショベル1の位置,またバケット10の位置を算出することができる。
図5は本実施形態に係る油圧ショベルが備えるMGならびにマシンコントロール(Machine Control:MC)システムの構成図である。図5のシステムは,MGとして,バケット10と任意に設定した目標面700とバケット10の位置関係を通達装置53を介してオペレータに通達する処理を実行することで,オペレータ操作を支援する。また,図5のシステムは,MCとして,操作装置45,46がオペレータに操作されたとき,フロント作業機1Aを予め定められた条件に基づいて制御する処理を実行する。例えば本実施形態では任意に設定した目標面700上又はその上方の領域にバケット10が保持されるようにMCが機能することがある。本稿ではMCを,操作装置45,46の非操作時に作業機1Aの動作をコンピュータにより制御する「自動制御」に対して,操作装置45,46の操作時にのみ作業機1Aの動作をコンピュータにより制御する「半自動制御」と称することがある。次に本実施形態におけるMG及びMCの詳細を説明する。
フロント作業機1AのMGとして,目標面700(図4参照)と作業機1Aの先端の位置関係を,通達装置53によりオペレータに通達する。本実施形態の通達装置53は表示装置(例えば液晶ディスプレイ)及び音声出力装置(例えばスピーカ)であり,これらを介して通達装置53はバケット10の爪先と目標面700の距離に関する操作支援情報をオペレータに通達する。詳細は後述するが,操作支援情報には,例えば,バケット10の爪先と目標面の距離表示や、バケット10が目標面700に近づいた際の警報が含まれる。後者の警報には,表示装置によるライトバー表示や,音声出力装置による警報音が含まれる。警報音は,例えば目標面700とバケット10の距離が第1閾値から第2閾値(第1閾値>第2閾値)の範囲では断続音とし,第2閾値未満の範囲では目標面700に近づくにつれ断続音の間隔を短くし,目標面700上にバケット10が存在しているとき(すなわち距離がゼロのとき)には連続音とする,といった方法がある。
フロント作業機1AのMCとしては,操作装置45b,46aを介して掘削操作(具体的には,アームクラウド,バケットクラウド及びバケットダンプの少なくとも1つの指示)が入力された場合,目標面700(図4参照)と作業機1Aの先端(本実施形態ではバケット10の爪先とする)の位置関係に基づいて,作業機1Aの先端の位置が目標面700上及びその上方の領域内に保持されるように油圧アクチュエータ5,6,7のうち少なくとも1つを強制的に動作させる制御信号(例えば,ブームシリンダ5を伸ばして強制的にブーム上げ動作を行う)を該当する流量制御弁15a,15b,15cに出力する。
このMCによりバケット10の爪先が目標面700の下方に侵入することが防止されるので,オペレータの技量の程度に関わらず目標面700に沿った掘削が可能となる。なお,本実施形態では,MC時のフロント作業機1Aの制御点を,油圧ショベルのバケット10の爪先(作業機1Aの先端)に設定しているが,制御点は作業機1Aの先端部分の点であればバケット爪先以外にも変更可能である。
図5のシステムは,作業機姿勢検出装置50と,目標面設定装置51と,オペレータ操作検出装置52aと,運転室内に設置され,目標面700と作業機1Aの位置関係を通達可能な通達装置53と,作業機1Aの作業対象となる現況地形800の位置情報を取得する現況地形取得装置96と,MG及びMCを司るコンピュータである制御コントローラ(制御装置)40とを備えている。
作業機姿勢検出装置50は,ブーム角度センサ30,アーム角度センサ31,バケット角度センサ32,車体傾斜角センサ33から構成される。これらの角度センサ30,31,32,33は作業機1Aの姿勢センサとして機能している。
目標面設定装置51は,目標面700に関する情報(各目標面の位置情報や傾斜角度情報を含む)を入力可能なインターフェースである。目標面設定装置51は,グローバル座標系(絶対座標系)上に規定された目標面の3次元データを格納した外部端末(図示せず)と接続されている。なお,目標面設定装置51を介した目標面の入力は,オペレータが手動で行っても良い。
オペレータ操作検出装置52aは,オペレータによる操作レバー1a,1b(操作装置45a,45b,46a)の操作によってパイロットライン144,145,146に生じる操作圧(第1制御信号)を取得する圧力センサ70a,70b,71a,71b,72a,72bから構成される。すなわち,作業機1Aに係る油圧シリンダ5,6,7に対する操作を検出している。
現況地形取得装置96としては,例えばショベル1に備えられたステレオカメラ,レーザスキャナ又は超音波センサ等が利用できる。これらの装置はショベル1から現況地形上の点までの距離を計測するものであり,現況地形取得装置96で取得した現況地形は膨大な量の点群の位置データで定義される。なお,現況地形の3次元データをステレオカメラ,レーザスキャナ又は超音波センサ等を搭載したドローン等により予め取得しておき,当該3次元データを制御コントローラ40内に取り込むためのインターフェースとして現況地形取得装置96を構成しても良い。
<フロント制御用油圧ユニット160>
図3に示すように,フロント制御用油圧ユニット160は,ブーム8用の操作装置45aのパイロットライン144a,144bに設けられ,操作レバー1aの操作量としてパイロット圧(第1制御信号)を検出する圧力センサ70a,70bと,一次ポート側がポンプライン170を介してパイロットポンプ48に接続されパイロットポンプ48からのパイロット圧を減圧して出力する電磁比例弁54aと,ブーム8用の操作装置45aのパイロットライン144aと電磁比例弁54aの二次ポート側に接続され,パイロットライン144a内のパイロット圧と電磁比例弁54aから出力される制御圧(第2制御信号)の高圧側を選択し,流量制御弁15aの油圧駆動部150aに導くシャトル弁82aと,ブーム8用の操作装置45aのパイロットライン144bに設置され,制御コントローラ40からの制御信号を基にパイロットライン144b内のパイロット圧(第1制御信号)を低減して出力する電磁比例弁54bを備えている。
また,フロント制御用油圧ユニット160は,アーム9用のパイロットライン145a,145bに設置され,操作レバー1bの操作量としてパイロット圧(第1制御信号)を検出して制御コントローラ40に出力する圧力センサ71a,71bと,パイロットライン145bに設置され,制御コントローラ40からの制御信号を基にパイロット圧(第1制御信号)を低減して出力する電磁比例弁55bと,パイロットライン145aに設置され,制御コントローラ40からの制御信号を基にパイロットライン145a内のパイロット圧(第1制御信号)を低減して出力する電磁比例弁55aが設けられている。
また,フロント制御用油圧ユニット160は,バケット10用のパイロットライン146a,146bには,操作レバー1aの操作量としてパイロット圧(第1制御信号)を検出して制御コントローラ40に出力する圧力センサ72a,72bと,制御コントローラ40からの制御信号を基にパイロット圧(第1制御信号)を低減して出力する電磁比例弁56a,56bと,一次ポート側がパイロットポンプ48に接続されパイロットポンプ48からのパイロット圧を減圧して出力する電磁比例弁56c,56dと,パイロットライン146a,146b内のパイロット圧と電磁比例弁56c,56dから出力される制御圧の高圧側を選択し,流量制御弁15cの油圧駆動部152a,152bに導くシャトル弁83a,83bとがそれぞれ設けられている。なお,図3では,圧力センサ70,71,72と制御コントローラ40との接続線は紙面の都合上省略している。
電磁比例弁54b,55a,55b,56a,56bは,非通電時には開度が最大で,制御コントローラ40からの制御信号である電流を増大させるほど開度は小さくなる。一方,電磁比例弁54a,56c,56dは,非通電時には開度をゼロ,通電時に開度を有し,制御コントローラ40からの電流(制御信号)を増大させるほど開度は大きくなる。このように各電磁比例弁の開度54,55,56は制御コントローラ40からの制御信号に応じたものとなる。
上記のように構成される制御用油圧ユニット160において,制御コントローラ40から制御信号を出力して電磁比例弁54a,56c,56dを駆動すると,対応する操作装置45a,46aのオペレータ操作が無い場合にもパイロット圧(第2制御信号)を発生できるので,ブーム上げ動作,バケットクラウド動作,バケットダンプ動作を強制的に発生できる。また,これと同様に制御コントローラ40により電磁比例弁54b,55a,55b,56a,56bを駆動すると,操作装置45a,45b,46aのオペレータ操作により発生したパイロット圧(第1制御信号)を減じたパイロット圧(第2制御信号)を発生することができ,ブーム下げ動作,アームクラウド/ダンプ動作,バケットクラウド/ダンプ動作の速度をオペレータ操作の値から強制的に低減できる。
本稿では,流量制御弁15a〜15cに対する制御信号のうち,操作装置45a,45b,46aの操作によって発生したパイロット圧を「第1制御信号」と称する。そして,流量制御弁15a〜15cに対する制御信号のうち,制御コントローラ40で電磁比例弁54b,55a,55b,56a,56bを駆動して第1制御信号を補正(低減)して生成したパイロット圧と,制御コントローラ40で電磁比例弁54a,56c,56dを駆動して第1制御信号とは別に新たに生成したパイロット圧を「第2制御信号」と称する。
第2制御信号は,第1制御信号によって発生される作業機1Aの制御点の速度ベクトルが所定の条件に反するときに生成され,当該所定の条件に反しない作業機1Aの制御点の速度ベクトルを発生させる制御信号として生成される。なお,同一の流量制御弁15a〜15cにおける一方の油圧駆動部に対して第1制御信号が,他方の油圧駆動部に対して第2制御信号が生成される場合は,第2制御信号を優先的に油圧駆動部に作用させるものとし,第1制御信号を電磁比例弁で遮断し,第2制御信号を当該他方の油圧駆動部に入力する。したがって,流量制御弁15a〜15cのうち第2制御信号が演算されたものについては第2制御信号を基に制御され,第2制御信号が演算されなかったものについては第1制御信号を基に制御され,第1及び第2制御信号の双方が発生しなかったものについては制御(駆動)されないことになる。上記のように第1制御信号と第2制御信号を定義すると,MCは,第2制御信号に基づく流量制御弁15a〜15cの制御ということもできる。
<制御コントローラ40>
図5において制御コントローラ40は,入力インターフェース91と,プロセッサである中央処理装置(CPU)92と,記憶装置であるリードオンリーメモリ(ROM)93及びランダムアクセスメモリ(RAM)94と,出力インターフェース95とを有している。入力インターフェース91には,作業機姿勢検出装置50である角度センサ30〜32及び傾斜角センサ33からの信号と,目標面700を設定するための装置である目標面設定装置51からの信号と,現況地形800を取得する現況地形取得装置96からの信号が入力され,CPU92が演算可能なように変換する。ROM93は,後述するフローチャートに係る処理を含めMGを実行するための制御プログラムと,当該フローチャートの実行に必要な各種情報等が記憶された記録媒体であり,CPU92は,ROM93に記憶された制御プログラムに従って入力インターフェース91及びROM93,RAM94から取り入れた信号に対して所定の演算処理を行う。出力インターフェース95は,CPU92での演算結果に応じた出力用の信号を作成し,その信号を通達装置53に出力することで,車体1B,バケット10及び目標面700等の画像を通達装置53の画面上に表示させる。
なお,図5の制御コントローラ40は,記憶装置としてROM93及びRAM94という半導体メモリを備えているが,記憶装置であれば特に代替可能であり,例えばハードディスクドライブ等の磁気記憶装置を備えても良い。
図6は,制御コントローラ40の機能ブロック図である。制御コントローラ40は,MG及びMC制御部43と,電磁比例弁制御部44と,通達制御部374を備えている。
通達制御部374は,MG及びMC制御部43から出力される情報(例えば作業機姿勢及び目標面の情報等)を基に通達装置53によって通達される操作支援情報の内容(以下「通達内容」と称することがある)を制御する部分である。通達制御部374には,作業機1Aの画像及びアイコンを含む表示関連データが多数格納されている表示ROMが備えられており,通達制御部374が,入力情報に含まれるフラグ(例えば図18の通達内容変更フラグと図19のMG対象目標面変更フラグ)に基づいて所定のプログラムを読み出すとともに,通達装置(表示装置)53における表示制御をする。また,通達装置(音声出力装置)53が出力する音声の内容についても制御する。通達制御部374は,予め設定された複数の目標面のうち所定の目標面とバケット10の距離に基づいて当該所定の目標面とバケット10の距離に関する警報(操作支援情報)としてライトバー表示や警報音を通達するか否かの判断も行っている。
<MG及びMC制御部43>
図7は図6中のMG及びMC制御部43の機能ブロック図である。MG及びMC制御部43は,操作量演算部43aと,姿勢演算部43bと,目標面演算部43cと,アクチュエータ制御部81と,目標面比較部62を備えている。
操作量演算部43aは,オペレータ操作検出装置52aからの入力を基に操作装置45a,45b,46a(操作レバー1a,1b)の操作量を算出する。圧力センサ70,71,72の検出値から操作装置45a,45b,46aの操作量が算出できる。
なお,圧力センサ70,71,72による操作量の算出は一例に過ぎず,例えば各操作装置45a,45b,46aの操作レバーの回転変位を検出する位置センサ(例えば,ロータリーエンコーダ)で当該操作レバーの操作量を検出しても良い。また,操作量から動作速度を算出する構成に代えて,各油圧シリンダ5,6,7の伸縮量を検出するストロークセンサを取り付け,検出した伸縮量の時間変化を基に各シリンダの動作速度を算出する構成も適用可能である。
姿勢演算部43bは作業機姿勢検出装置50からの情報に基づき,ローカル座標系(ショベル基準座標)におけるフロント作業機1Aの姿勢と,バケット10の爪先の位置を演算する。既述のとおり,バケット10の爪先位置(Xbk,Zbk)は,式(1)及び式(2)により演算できる。
目標面演算部43cは,目標面設定装置51からの情報に基づき目標面700の位置情報を演算し,これをRAM94内に記憶する。本実施形態では,図4に示すように,3次元の目標面を作業機1Aが移動する平面(作業機の動作平面)で切断した断面形状を目標面700(2次元の目標面)として利用する。
なお,図4の例では目標面700は1つだが,目標面が複数存在する場合もある。目標面が複数存在する場合には,例えば,作業機1Aから最も近いものを目標面と設定する方法や,バケット爪先の下方に位置するものを目標面とする方法や,任意に選択したものを目標面とする方法等がある。
アクチュエータ制御部81は,操作装置45a,45b,46aの操作時に,予め定めた条件に従って複数の油圧アクチュエータ5,6,7の少なくとも1つを制御する。本実施形態のアクチュエータ制御部81は,後述する図16,17,21のように,操作装置45a,45b,46aの操作時に,目標面700の位置と,フロント作業機1Aの姿勢及びバケット10の爪先の位置と,操作装置45a,45b,46aの操作量とに基づいて,目標面700上またはその上方にバケット10の爪先(制御点)が位置するように(すなわち、作業機1Aの動作範囲が目標面700上及びその上方に制限されるように)ブームシリンダ5(ブーム8)の動作を制御するMCを実行する。アクチュエータ制御部81は,各油圧シリンダ5,6,7の流量制御弁15a,15b,15cの目標パイロット圧を演算し,その演算した目標パイロット圧を電磁比例弁制御部44に出力する。また,アクチュエータ制御部81は通達内容変更フラグの有無に応じてMCの制御内容(具体的にはMCによって制限される作業機1Aの動作範囲)を切り替える。アクチュエータ制御部81によるMCの詳細は図16,17,21を用いて後述する。
目標面比較部62は,現況地形800と所定の目標面700の位置を比較して両者の上下関係を判定する部分である。判定結果はフラグ(例えば図18の通達内容変更フラグと図19のMG対象目標面変更フラグ)として,アクチュエータ制御部81と通達制御部374に出力される。
電磁比例弁制御部44は,アクチュエータ制御部81から出力される各流量制御弁15a,15b,15cへの目標パイロット圧を基に,各電磁比例弁54〜56への指令を演算する。なお,オペレータ操作に基づくパイロット圧(第1制御信号)と,アクチュエータ制御部81で算出された目標パイロット圧が一致する場合には,該当する電磁比例弁54〜56への電流値(指令値)はゼロとなり,該当する電磁比例弁54〜56の動作は行われない。
通達制御部374は,姿勢演算部43bで演算された姿勢情報,目標面演算部43cで演算された目標面情報を,どのようにオペレータに通達するかを,目標面比較部62の比較結果に基づき制御する。
<目標面比較部62>
次に目標面比較部62の処理の詳細について説明する。目標面比較部62は,現況地形800と目標面700の上下関係を判定し,その判定結果に基づく通達内容変更フラグとMG対象目標面変更フラグをアクチュエータ制御部81と通達制御部374に出力する。まず,通達内容変更フラグとMG対象目標面変更フラグの出力処理の説明の前に,現況地形800と目標面700の上下関係の判定方法について図8を用いて説明する。
図8に示すように,目標面比較部62は,現況地形取得装置96を介して取得した現況地形800の位置情報を,例えばショベル基準座標に変換された点群801として入力する。入力された点群801は,例えば線分で結ぶことで,複数の線分802として表現される。目標面比較部62は,目標面演算部43cからショベル基準座標における目標面700を取得する。目標面700は単一の場合もあれば,複数の場合もある。
目標面比較部62は,ショベル基準座標における目標面700と,現況地形を表す直線802の位置関係を比較する。本実施形態では下記の(1)―(3)の比較方法を利用している。この比較方法について,例えば図8に示すように,目標面700が,目標面700A,目標面700B,目標面700Cとなり,線分802が,線分802A,線分802B,線分802Cとなっている状況で説明する。
(1)本実施形態では,原則,MG及びMCの基準となる目標面700の線分から現況地形800の線分上の任意の点を通る法線を作成し,その法線のZ方向成分の方向(符号)から目標面700と現況地形800の上下関係を判定している。例えば図8では,目標面700Aの法線のうち,線分802Aの任意の点を通るものが法線701Aとして算出できる。そして法線701AのZ方向成分は正の向きであるため,線分802Aは目標面700Aに対し上方に位置すると判定できる。
(2)また,本実施形態では,目標面700の線分と現況地形800の線分の交差点を探索し,その交差点からX方向の正方向に所定距離離れた目標面700の線分上の点から現況地形800の線分を通る法線を作成しつつ,当該交差点からX方向の負方向に当該所定距離離れた目標面700の線分上の点から現況地形800の線分を通る法線を作成する。そしてその2つの法線のZ方向成分の方向(符号)から当該交差点の前後における目標面700と現況地形800の上下関係を判定する。
例えば,図8において目標面700Aと線分802Bは交差点803Aで交差していることが判定できる。そこで,目標面700Aの法線のうち,交差点803AよりもX方向正の位置を始点とし線分802Bを通る法線を701Bとし,交差点803AよりもX方向負の位置を始点とし線分802Bを通る法線を701Cとする。ここで,法線701BのZ方向成分は正の向きであるため,線分802Bは,交差点803AよりもX方向正の位置において,目標面700Aに対し上方に位置すると判定できる。また,法線701CのZ方向成分は負の向きであるため,線分802Bは点803AよりもX方向負の位置において,目標面700Aに対し下方に位置すると判定できる。
(3)さらに,本実施形態では,目標面700の線分の変曲点を探索し,その変曲点から現況地形800の線分を通る法線を作成し,その法線のZ方向成分の方向から目標面700(変曲点)と現況地形800の上下関係を判定する。変曲点とは,傾斜の異なる目標面700同士の接続点を表す。例えば,目標面700Aと700Bは,変曲点702Aにおいて接続している。目標面700Aの法線であり,変曲点702A及び線分802Bを通る法線701DのZ方向成分は負の向きであるため,変曲点702Aは線分802Bに対し上方に位置すると判定できる。
目標面700Bでは,上記(1)の方法に基づいて線分802Bと802Cの接続点801Cを通る法線701Eが作成され,そのZ方向成分は負の向きである。そのため,目標面700Bは線分802Bの上方に位置すると判定できる。
次に,目標面700Bと線分802Cは交差点803Bで交差していることが判定できる。そこで,上記(2)の方法に基づき,線分700Bの法線のうち,点803BよりもX方向正の位置を始点とし線分802Cを通る法線を701F,点803BよりもX方向負の位置を始点とし線分802Cを通る法線を701Gとする。ここで,法線701FのZ方向成分は負であるため,線分802Cは,交差点803BよりもX方向正の位置において,目標面700Bに対し下方に位置すると判定できる。また,法線71GのZ方向成分は負の向きであるため,線分802Cは交差点803BよりもX方向正の位置において,目標面700Bに対し上方に位置すると判定できる。
次に,目標面700Bと目標面700Cは,変曲点702Bにおいて接続している。そこで,上記(3)の方法に基づいて変曲点702B及び線分802Cを通る法線701Hが作成される。その法線701HのZ方向成分は正の向きであるため,変曲点702Bは線分802Cに対し下方に位置すると判定できる。
また,目標面700Cでは,上記(1)の方法に基づいて線分802Cの任意の点を通る法線701Iが作成される。この法線701IのZ方向成分は正の向きであるため,目標面700Cは線分802Cに対して下方に位置すると判定できる。
図8の状況では,目標面比較部62は,X方向位置を基準として,目標面700Aの左端部から,交差点803Aまでを領域A,交差点803Aから交差点803Bまでを領域B,交差点803Bから目標面700Cの右端までを領域Cとして認識する。領域AおよびCは,現況地形800が目標面700より上方にある領域であり,領域Bは現況地形800が目標面700より下方にある領域である。
<作業機1Aの可動範囲情報の利用>
本実施形態の目標面比較部62は,図8で説明した目標面700と現況地形800の位置関係の比較に際して,作業機1Aの可動範囲情報を用いて,目標面700と現況地形800の位置関係を比較する範囲を限定している。次にこの点について図9,10を用いて説明する。
図9に作業機1Aの可動範囲,作業可能範囲D,作業不可能範囲Fを示す。図9では,斜線を付した領域が作業可能範囲Dを示し,ドットを付した領域が作業不可能範囲Fを示し,この2つの範囲D,Fを合わせたものを可動範囲とする。これらの範囲は,ブーム8,アーム9,バケット10の寸法,およびブームシリンダ5,アームシリンダ6,バケットシリンダ7のストローク又は角度により決定される。
本稿では,掘削作業の可否に関わらず,バケット10の爪先が移動可能な範囲を「可動範囲」とする。可動範囲は,作業機1Aによる掘削作業が可能な範囲(作業可能範囲)と,作業機1Aによる掘削作業が不可能な範囲(作業不可能範囲)に区分できる。作業不可能範囲は,ブーム8を最大に上げた状態(ブーム角αが最小値)で作業機1Aによる掘削作業が不可能な範囲である。作業可能範囲において作業不可能範囲に隣接する部分には,ブーム8を最大に上げた状態(ブーム角αが最小値)で作業機1Aにより掘削作業が可能な範囲(「ブーム最大上げ作業可能範囲」と称する)が存在する。
本実施形態では,「可動範囲」は,円弧439a及び円弧439bと,円弧438a,円弧438b及び円弧438cで挟まれる領域と規定した。円弧439aは,作業機1Aの長さが最大(最大掘削半径)Lmaxとなるアーム9とバケット10の姿勢(「最大リーチ姿勢」と称することがある)で,ブーム角αを最小値と最大値との間で変化させたときのバケット10の先端が描く軌跡である。なお,最大リーチ姿勢のときのバケット角γを「最大リーチ角」と称することがある。円弧439bは,最大リーチ姿勢でブーム角αが最大値の状態から,アーム角βを最小値と最大値との間で変化させたときにバケット10の先端が描く軌跡である。円弧438aは,ブーム角αを最小値かつアーム角βを最小値にした状態で,バケットシリンダ長を最小値と最大値との間で変化させたときにバケット10の先端が描く軌跡である。円弧438bは,ブーム角αを最小値かつバケットシリンダ長を最大値にした状態で,アーム角βを最小値と最大値との間で変化させたときにバケット10の先端が描く軌跡である。円弧438cは,ブーム角αを最小値かつアーム角βを最大値にした状態で,バケットシリンダ長を最小値と最大値との間で変化させたときにバケット10の先端が描く軌跡である。
本実施形態では,「可動範囲」を円弧Eで「作業可能範囲D」と「作業不可能範囲F」に区分した。すなわちこれら2つの範囲D,Fの境界線が円弧Eである。図6における円弧Eの上方の領域が作業不可能範囲Fであり,円弧Eの下方の領域が作業可能範囲Dである。円弧Eは,ブーム角αが最小値かつバケットシリンダ長が最小値(バケット角γが負側の最大値)で,アーム角βを最小値と最大値の間で変化させたときにバケット10の先端が描く軌跡であり,ブーム8を最大に上げた状態(ブーム角αが最小値)で作業機1Aにより掘削作業が可能な範囲(「ブーム最大上げ作業可能範囲」(第1範囲))である。範囲Fは,円弧Eと,円弧438a,円弧438bおよび円弧438cで挟まれた領域として規定される。
「作業可能範囲D」は,上部旋回体12から相対的に遠い方に位置する円弧439a及び円弧439bと,上部旋回体12から相対的に近い方に位置する円弧Eで挟まれた領域として規定されている。
本実施形態の目標面比較部62は,後述の図18からも明らかであるが,上記のように定義された作業可能範囲Dに含まれる,目標面700と現況地形800についてのみ,位置関係を比較している。例えば図10において,作業可能範囲Dに含まれる部分についてのみ目標面700と現況地形800の位置関係を比較する。その場合,目標面比較部62は作業機1Aが届かない範囲について現況地形800と目標面700の位置関係を比較しないため,制御コントローラ40の演算負荷を低減可能となる。
なお,作業可能範囲Dに代えて可動範囲を利用して目標面700と現況地形800の上下関係を判定しても良い。また,両者700,800の上下関係の判定の際に作業機1Aの可動範囲情報を利用することは必須ではなく,目標面700と現況地形800の取得範囲の重複範囲で両者の比較を行うこととしても良い。
<通達内容変更フラグ>
次に目標面比較部62による通達内容変更フラグの出力処理について図18を用いて説明する。図18は目標面比較部62における通達内容変更フラグに関するフローチャートである。
まずステップSC100において,目標面比較部62は現況地形取得装置96から油圧ショベル1の周辺の現況地形800の位置情報を取得する。
次にステップSC101では,目標面比較部62はオペレータによって掘削操作が行われているかどうか判定する。この判定を行うことで,掘削中に通達内容変更フラグの変更が生じず,掘削中に通達内容が切り替わることがないため,オペレータに違和感を生じさせないようにできる。掘削操作が行われているかどうかは,アクチュエータ制御部81が演算するシリンダ速度やバケット10の先端部の速度に基づいて判定できる。また,オペレータ操作検出装置52aからの情報に基づき,アーム9またはバケット10による掘削操作が行われているかどうかに基づいて判定しても良い。なお,ステップSC101の判定を省略して,ステップSC100の後にステップSC103に進むようにフローを構成しても良い。
ステップSC101で掘削操作中ではないと判定された場合,ステップSC103へ進む。反対に,掘削操作中と判定された場合は,ステップSC110へ進み,比較処理を行わずに通達内容変更フラグを前回値に保持する。
ステップSC103では,目標面比較部62は現況地形800の少なくとも一部が作業可能範囲Dに存在するかどうかを判定する。現況地形800の少なくとも一部が作業可能範囲Dに存在すると判定された場合にはステップSC104へ進み,現況地形800のいずれの部分も作業可能範囲Dに存在しないと判定された場合はステップSC108へ進む。
ステップSC104では,目標面比較部62は目標面700の少なくとも一部が作業可能範囲Dに存在するかどうかを判定する。目標面700の少なくとも一部が作業可能範囲Dに存在すると判定された場合にはステップSC105へ進み,目標面700のいずれの部分も作業可能範囲Dに存在しないと判定された場合にはステップSC109へ進む。
ステップSC105では,目標面比較部62は作業可能範囲Dに存在する現況地形800と目標面700について,現況地形800が目標面700より下方にある領域が存在するかどうかを判定する。現況地形800と目標面700の上下関係の判定は図8で説明した方法に基づく。現況地形800が目標面700より下方にある領域が存在すると判定された場合はステップSC106へ進む。そのように判定されなかった場合(現況地形800が目標面700の上方にある領域のみの場合)はステップSC109へ進む。
ステップSC106では,目標面比較部62は,バケット10の先端部(すなわち作業機1A)に最も近い目標面700が,ステップSC105で現況地形800が目標面700より下方にあると判定された領域内に存在するかどうかを判定する。バケット10と最も近い目標面700が現況地形800より下方にあると判定された場合,ステップSC107へ進む。そのように判定されなかった場合(バケットと最も近い目標面700が現況地形800より下方にない場合)はステップSC109へ進む。
ステップSC107では,目標面比較部62は,現況地形800が目標面700より下方にある(すなわち盛土作業中である)と判定し,通達内容変更フラグを立て,その結果を通達制御部374及びアクチュエータ制御部81等に出力する。なお,通達内容変更フラグが立つ場合としては,ステップSC106とステップSC108のどちらか一方を経由する合計2つのパターンが存在するが,目標面比較部62が出力する通達内容変更フラグの情報には,ステップSC106とステップSC108のどちらを経由したものであるかが付加されているものとする。
ステップSC109では,目標面比較部62は,通達内容変更フラグを立てず(既に通達内容変更フラグが立っている場合には下ろす),その結果を通達制御部374及びアクチュエータ制御部81等に出力する。
ところで,ステップSC108では,目標面700の少なくとも一部が作業可能範囲Dに存在するかどうかを判定する。判定された場合,ステップSC107へ進む。判定されなかった場合,ステップSC109へ進む。
図8の例で図18のフローに基づく処理を行うと,現況地形800が目標面700より下方にあるとき,つまり領域Bでは通達内容変更フラグが立つが,現況地形800が目標面700より上方にある残りの領域A,Cでは通達内容変更フラグは下ろされる。
<MG対象目標面変更フラグ>
次に目標面比較部62によるMG対象目標面変更フラグの出力処理について図19を用いて説明する。図19は目標面比較部62におけるMG対象目標面変更フラグに関するフローチャートである。
まずステップSD100において,目標面比較部62は,図18のフローチャートにおいてステップSC106を通った通達内容変更フラグが立っているかを判定する。このフラグが立っていると判定された場合はステップSD101へ進み,そうではない場合にはステップSD103に進む。
ステップSD101では,目標面比較部62は,作業可能範囲Dに存在するバケット10に最も近い目標面と隣接する2つの目標面のうちバケット10の先端の速度ベクトルの方向(すなわちバケット10の動作方向)にある目標面が,現況地形800の下方に位置するかどうかを判定する。ここで判定対象となる目標面を別の言い方で表現すると,バケット先端の速度ベクトルが車体1Bに向かっている場合には,バケット10に最も近い目標面に隣接する2つの目標面のうち車体1Bに近い方の目標面が判定対象となり,バケット先端の速度ベクトルが車体1Bから離れる方向に向かっている場合には,当該2つの目標面のうち車体から遠い方の目標面が判定対象となる。判定対象の目標面が現況地形800の下方に位置すると判定された場合にはステップSD102に進み,そうではないと判定された場合にはステップSD103に進む。
ステップSD102では,目標面比較部62は,バケット10の動作方向にある目標面(間もなく「バケット10に最も近い目標面」になり得る目標面)は現況地形800の下方に位置するため,事前にMGの対象目標面に設定して目標面とバケット10の距離に関する警報を通達すべきと判定して,MG対象目標面変更フラグを立て,その結果を通達制御部374等に出力する。
ステップSD103では,目標面比較部62は,MG対象目標面変更フラグを立てず(既にMG対象目標面変更フラグが立っている場合には下ろす),その結果を通達制御部374等に出力する。
例えば,図8において,領域Bから領域Cにバケット10が移動していると判定されるとき,MG対象目標面変更フラグが立つ。
このように,MG対象目標面変更フラグを立ててMGの対象目標面を変更することで,より適切なMGを実施できる。つまり,バケット10が侵入しても現況地形800を掘りすぎる恐れのない目標面700ではなく,バケット10が侵入すると現況地形800を掘りすぎる恐れのある目標面700をMGの対象とすることで,オペレータにより適切なMGを行うことができる。
具体的には,図20に示すように,従来のMGでは,バケット10と目標面の距離に応じてMGを実施するため,バケット10に最も近い目標面(ここでは「最短目標面」と称することがある)700DをMGの対象とするが,本実施形態では,バケット10との距離が最も近い目標面700Dではなく,バケット10の動作方向で目標面700Dと隣接する目標面(ここでは「移動先目標面」と称することがある)700EをMGの対象とする。
<通達制御部374>
次に通達制御部374の処理の詳細について説明する。通達制御部374による通達内容の制御フローを図11に示す。本実施形態の通達制御部374は,MG対象の所定の目標面とバケット10の距離(目標面距離)に基づいて通達装置53を介した当該目標面距離に関する警報を通達するか否かを制御している。そして,当該警報を通達すべき場面であると当該目標面距離のみに基づいて判断した場合であっても,目標面比較部62の判定結果である2つのフラグ(通達内容変更フラグとMG対象目標面変更フラグ)の有無に基づいて当該警報を含む操作支援情報の内容を変更する処理を実行する。
まず,ステップSB100で通達制御部374は,目標面比較部62から通達内容変更フラグが入力されているかどうかを判定する。通達内容変更フラグが入力されている場合はステップSB101へ進み,入力されていない場合はステップSB108に進む。
ステップSB101では,通達制御部374は,目標面比較部62からMG対象目標面変更フラグが入力されているかどうかを判定する。MG対象目標面変更フラグが入力されている場合はSB102へ進み,入力されていない場合はステップSB105に進む。
次にステップSB102,105,108に進んだ場合の3つに分けて処理を説明する。
(A)ステップSB102
ステップSB102に進む場面は,バケット10に最も近い目標面(最短目標面)700が現況地形800の上方に位置するが(すなわち現在は盛土作業が行われ得る状況であるが),その最短目標面とバケット10の動作方向で隣接する目標面(移動先目標面)は現況地形の下方に位置すると判定される場合(すなわち間もなく掘削作業の開始が予測され得る場合)である。この場合,通達制御部374はMG対象目標面を移動先目標面に指定し,通達装置53を介して移動先目標面とバケット10の距離に関する警報を通達するものとする。具体的にはステップSB102,103,104の警報処理を実行する。
すなわち,ステップSB102では,通達制御部374は,目標面演算部43Cが出力する目標面700とバケット10の爪先の距離のうち,目標面比較部62が指定する移動先目標面700とバケット10の爪先の距離のデータを,通達装置53(表示装置)へ出力して画面に表示する。
次のステップSB103では,通達制御部374は,目標面演算部43Cが出力する目標面700とバケット10の爪先の距離のうち,目標面比較部62が指定する移動先目標面700とバケット10の爪先の距離に基づいた警告音指令を通達装置53(音声出力装置)へ出力して警告音を発生する。ただし,警告音が出力される距離の閾値は決まっており,MC対象の目標面とバケット10の距離が当該閾値を下回った場合に警告音が出力されるように構成されている。
そしてステップSB104では,通達制御部374は,目標面演算部43Cが出力する目標面700とバケット10の爪先の距離のうち,目標面比較部62が指定する移動先目標面700とバケット10の爪先の距離に基づいたライトバー指令を通達装置53(表示装置)へ出力する。
図14は,ステップSB102に進んだ場合の通達装置53の表示画面53aの例である。表示画面53aには,バケット10と目標面700の位置関係が画像で表示されるシンボル表示部531Aと,バケット10からMG対象目標面までの距離が数値で表示される数値表示部531Bと,バケット10を基準としてMG対象目標面が位置する方向が矢印で表示される矢印表示部531Cと,バケット10からMG対象目標面までの距離がライトバーで視覚的に表示されるライトバー表示部531Dが設けられている。
シンボル表示部531Aでは,バケット10が侵入すると現況地形を掘りすぎる可能性がある目標面700B(移動先目標面)を実線で表示する。一方,侵入しても現況地形を掘りすぎる可能性がない目標面700A(最短目標面)は破線で表示する。
数値表示部531Bには,ステップSB102で出力された目標面700Bとバケット10の距離(0.20m)を表示する。
矢印表示部531Cに表示される矢印には上向きと下向きのものがあり,下向きの矢印はバケット爪先より下方にMG対象目標面が位置し,上向きの矢印はバケット爪先より上方にMG対象目標面が位置することを示す。図14の例では矢印は下向きであり,MG対象目標面700Bが爪先より下方にあることを示している。
ライトバー表示部531Dは,目標面700Bとバケット10の距離に応じて点灯する。図14のライトバーは縦方向に直列配置された5つの点灯可能なセグメントで構成されており,図中で点灯中の上側の3つのセグメントにはドットを付している。本実施形態では,爪先がMG対象目標面から±0.05mの距離に存在する場合には中央のセグメントのみが点灯する。爪先がMG対象目標面から0.05〜0.10mの距離に存在する場合には中央のセグメント及びその上のセグメントの2つが点灯し,爪先がMG対象目標面から0.10mを越える距離に存在する場合には中央のセグメント及びその上の2つのセグメントの3つが点灯する。同様に距離が−0.05〜−0.10mを場合には中央とその下のセグメントの2つが点灯し,距離が−0.10mを越える場合には中央とその下の2つのセグメントの3つが点灯する。図14の例では,MG対象目標面までの距離が+0.20mなので,図11のステップSB104で出力されるライトバー指令に基づいて上側の3つのセグメントが点灯している。
図15は,図14に示した表示画面の変形例を示すものである。共通部分の説明は省略する。図15では,数値表示部531Bと,矢印表示部531Cを変形した例を示している。数値表示部531Bと,矢印表示部531Cについて,括弧内に示されているものは,MG対象ではない目標面700A(最短目標面)に対する数値及び矢印であり,MG対象である目標面700Bに対する数値及び矢印より小さく表示されている。このように,MG対象である目標面700Bに対するもののみではなく。非MG対象の目標面700Aに対するバケット10の位置情報を付加表示すると,2つの目標面700A,700Bに対するバケット10の位置情報をオペレータが把握できる。
(B)ステップSB105
ステップSB105に進む典型的な場面としては,バケット10に最も近い目標面(最短目標面)700が現況地形800の上方に位置し(すなわち現在は盛土作業が行われ得る状況であり),その最短目標面とバケット10の動作方向で隣接する目標面(移動先目標面)も現況地形の上方に位置すると判定される場合(すなわち移動先でも盛土作業が予測される場合)である。また,最短目標面が現況地形の上方に位置するが,移動先目標面は存在しない場合も含まれる。このような場合,通達制御部374はMG対象目標面を最短目標面に指定し,通達装置53を介してMG対象目標面(最短目標面)とバケット10の距離の数値は通達するものの,警告音とライトバーに関する通達は中止するものとする。具体的にはステップSB105,106,107の警報処理を実行する。
すなわち,ステップSB105では,通達制御部374は,目標面演算部43Cが出力する目標面700とバケット10の爪先の距離のうち,バケット10に最も近い最短目標面700とバケット10の爪先の距離のデータを,通達装置53(表示装置)へ出力して画面に表示する。
次のステップSB106では,通達制御部374は,最短目標面700とバケット10の爪先の距離に基づく警告音指令をOFFにするよう,通達装置53へ出力する。これにより通達装置53(音声出力装置)からの警告音の発生が中止される。
そしてステップSB107では,通達制御部374は,最短目標面700とバケット10の爪先の距離に基づくライトバー指令をOFFにするよう,通達装置53へ出力する。これにより通達装置53(表示装置)におけるライトバーの全てのセグメントの点灯が中止される。
図13は,ステップSB105に進んだ場合の通達装置53の表示画面53aの例である。このとき,目標面700よりも現況地形が下方にある状況であるため,バケット10が目標面700の下方に侵入しても現況地形を掘りすぎる恐れがない。そのため,シンボル表示部531Aにおいて,目標面700を示す線は破線として表示される。また,ライトバー表示部531Dはいずれのセグメントも点灯しないし,通達装置53(音声出力装置)から警告音も出力されない。
(C)ステップSB108
ステップSB108に進む典型的な場面としては,バケット10に最も近い最短目標面700が現況地形800の下方に位置する場合(すなわち現在は掘削作業が行われ得る一般的な状況)である。この場合,通達制御部374はMG対象目標面を最短目標面に指定し,通達装置53を介して最短目標面とバケット10の距離に関する警報を通達するものとする。具体的にはステップSB108,109,110の警報処理を実行する。
すなわち,ステップSB108では,通達制御部374は,目標面演算部43Cが出力する目標面700とバケット10の爪先の距離のうち,バケット10に最も短い最短目標面700とバケット10の爪先の距離のデータを,通達装置53(表示装置)へ出力して画面に表示する。
次のステップSB109では,通達制御部374は,目標面演算部43Cが出力する目標面700とバケット10の爪先の距離のうち,最短目標面700とバケット10の爪先の距離に基づいた警告音指令を通達装置53(音声出力装置)へ出力して警告音を発生する。この場合の警告音が出力される距離の閾値はステップSB103と同じとする。
そしてステップSB110では,通達制御部374は,目標面演算部43Cが出力する目標面700とバケット10の爪先の距離のうち,最短目標面700とバケット10の爪先の距離に基づいたライトバー指令を通達装置53(表示装置)へ出力する。
図12は,ステップSB108に進んだ場合の通達装置53の表示画面53aの例である。シンボル表示部531Aには,バケット10が侵入すると現況地形を掘りすぎる可能性がある目標面700が実線で表示される。また,数値表示部531Bには最短目標面700とバケット10の距離(0.00m)が表示されている。この図の例では,バケット10と目標面700の距離が零であるため,矢印表示部531Cには上向きと下向きの矢印の両方が表示される。さらに,ライトバー表示部531Dに関しては,バケット10と目標面700の距離が零であるため,中央のセグメントのみが点灯している。
<アクチュエータ制御部81>
次にアクチュエータ制御部81の処理の詳細について説明する。本実施形態のアクチュエータ制御部81は,MCとして,目標面700へのバケット10の侵入防止動作をブーム上げ制御により実行する。このアクチュエータ制御部81によるブーム上げ制御のフローを図16に示す。図16はアクチュエータ制御部81で実行されるMCのフローチャートであり,操作装置45a,45b,46aがオペレータにより操作されると処理が開始される。
S410では,アクチュエータ制御部81は,操作量演算部43aで演算された操作量を基に各油圧シリンダ5,6,7の動作速度(シリンダ速度)を演算する。
S420では,アクチュエータ制御部81は,S410で演算された各油圧シリンダ5,6,7の動作速度と,姿勢演算部43bで演算された作業機1Aの姿勢とを基に,オペレータ操作によるバケット先端(爪先)の速度ベクトルBを演算する。
S430では,アクチュエータ制御部81は,姿勢演算部43bで演算したバケット10の爪先の位置(座標)と,ROM93に記憶された目標面700を含む直線の距離から,バケット先端から制御対象の目標面700(多くの場合,最短目標面が該当する)までの距離D(図4参照)を算出する。次に,アクチュエータ制御部81は,目標面比較部62からの入力信号を基に通達内容変更フラグが立っているか否かを判定する。通達内容変更フラグが下りている場合(すなわち目標面700が現況地形800の下方に位置する掘削作業の場合),アクチュエータ制御部81は,距離Dと図17のグラフを基にバケット先端の速度ベクトルの目標面700に垂直な成分の制限値ayを算出する。図17の制限値ayは,距離Dごとに設定されており,距離Dが減少に応じて増加するように設定されている。一方,通達内容変更フラグが立っている場合(すなわち目標面700が現況地形800の上方に位置する盛土作業の場合)には距離Dと図21のグラフを基に制限値ayを算出する。図21のグラフでは,すべての距離Dにおいて,図17のグラフよりも制限値ayが低減するように設定されている。また,本実施形態では,制限値ayの絶対値を充分大きくし,バケット先端の速度ベクトルBの目標面700に垂直な成分byが取り得る絶対値よりも大きなものとしている。
S440では,アクチュエータ制御部81は,S420で算出したオペレータ操作によるバケット先端の速度ベクトルBにおいて,目標面700に垂直な成分byを取得する。
S450では,アクチュエータ制御部81は,S430で算出した制限値ayが0以上か否かを判定する。なお,図16の右上に示したようにxy座標を設定する。当該xy座標では,x軸は目標面700と平行で図中右方向を正とし,y軸は目標面700に垂直で図中上方向を正とする。図16中の凡例では垂直成分by及び制限値ayは負であり,水平成分bx及び水平成分cx及び垂直成分cyは正である。図17から明らかであるが,制限値ayが0のときは距離Dが0,すなわち爪先が目標面700上に位置する場合であり,制限値ayが正のときは距離Dが負,すなわち爪先が目標面700より下方に位置する場合であり,制限値ayが負のときは距離Dが正,すなわち爪先が目標面700より上方に位置する場合である。S450で制限値ayが0以上と判定された場合(すなわち,爪先が目標面700上またはその下方に位置する場合)にはS460に進み,制限値ayが0未満の場合にはS480に進む。
S460では,アクチュエータ制御部81は,オペレータ操作による爪先の速度ベクトルBの垂直成分byが0以上か否かを判定する。byが正の場合は速度ベクトルBの垂直成分byが上向きであることを示し,byが負の場合は速度ベクトルBの垂直成分byが下向きであることを示す。S460で垂直成分byが0以上と判定された場合(すなわち,垂直成分byが上向きの場合)にはS470に進み,垂直成分byが0未満の場合にはS500に進む。
S470では,アクチュエータ制御部81は,制限値ayと垂直成分byの絶対値を比較し,制限値ayの絶対値が垂直成分byの絶対値以上の場合にはS500に進む。一方,制限値ayの絶対値が垂直成分byの絶対値未満の場合にはS530に進む。
S500では,アクチュエータ制御部81は,マシンコントロールによるブーム8の動作で発生すべきバケット先端の速度ベクトルCの目標面700に垂直な成分cyを算出する式として「cy=ay−by」を選択し,その式とS430の制限値ayとS440の垂直成分byを基に垂直成分cyを算出する。そして,算出した垂直成分cyを出力可能な速度ベクトルCを算出し,その水平成分をcxとする(S510)。
S520では,目標速度ベクトルTを算出する。目標速度ベクトルTの目標面700に垂直な成分をty,水平な成分txとすると,それぞれ「ty=by+cy,tx=bx+cx」と表すことができる。これにS500の式(cy=ay−by)を代入すると目標速度ベクトルTは結局「ty=ay,tx=bx+cx」となる。つまり,S520に至った場合の目標速度ベクトルの垂直成分tyは制限値ayに制限され,マシンコントロールによる強制ブーム上げが発動される。
S480では,アクチュエータ制御部81は,オペレータ操作による爪先の速度ベクトルBの垂直成分byが0以上か否かを判定する。S480で垂直成分byが0以上と判定された場合(すなわち,垂直成分byが上向きの場合)にはS530に進み,垂直成分byが0未満の場合にはS490に進む。
S490では,アクチュエータ制御部81は,制限値ayと垂直成分byの絶対値を比較し,制限値ayの絶対値が垂直成分byの絶対値以上の場合にはS530に進む。一方,制限値ayの絶対値が垂直成分byの絶対値未満の場合にはS500に進む。
S530に至った場合,マシンコントロールでブーム8を動作させる必要が無いので,フロント制御装置81dは,速度ベクトルCをゼロとする。この場合,目標速度ベクトルTは,S520で利用した式(ty=by+cy,tx=bx+cx)に基づくと「ty=by,tx=bx」となり,オペレータ操作による速度ベクトルBと一致する(S540)。
S550では,アクチュエータ制御部81は,S520またはS540で決定した目標速度ベクトルT(ty,tx)を基に各油圧シリンダ5,6,7の目標速度を演算する。なお,上記説明から明らかであるが,図11の場合に目標速度ベクトルTが速度ベクトルBに一致しないときには,マシンコントロールによるブーム8の動作で発生する速度ベクトルCを速度ベクトルBに加えることで目標速度ベクトルTを実現する。
S560では,アクチュエータ制御部81は,S550で算出された各シリンダ5,6,7の目標速度を基に各油圧シリンダ5,6,7の流量制御弁15a,15b,15cへの目標パイロット圧を演算する。
S590では,アクチュエータ制御部81は,各油圧シリンダ5,6,7の流量制御弁15a,15b,15cへの目標パイロット圧を電磁比例弁制御部44に出力する。
電磁比例弁制御部44は,各油圧シリンダ5,6,7の流量制御弁15a,15b,15cに目標パイロット圧が作用するように電磁比例弁54,55,56を制御し,これにより作業機1Aによる掘削が行われる。例えば,オペレータが操作装置45bを操作して,アームクラウド動作によって水平掘削を行う場合には,バケット10の先端が目標面700に侵入しないように電磁比例弁55cが制御され,ブーム8の上げ動作が自動的に行われる。
なお,MCとして実行されるものは,説明したブーム上げ動作の自動制御に限定されるものではなく,たとえばバケット10を自動で回動させ,目標面700とバケット10の底部がなす角度を一定に保つ制御が実行されても良い。
<MGの動作と効果>
次に油圧ショベル1の通達制御部374(制御コントローラ40)により行われるMGの動作について図8を用いて説明する。
まず,図8の領域Aの目標面700Aと現況地形802Aを作業可能範囲D内に含めて油圧ショベル1で掘削作業をする場合には,目標面比較部62が作業機1Aに最も近い目標面700Aは現況地形802Aの下方に位置すると判定し,図18のステップSC109が選択され通達内容変更フラグは立たない。そのため,図11のフローに基づいてステップSB108,109,110が実行され,最短目標面700Aとバケット10の距離に関する警報が図12のように通達装置53を介して通達される。その際,通達装置53には操作支援情報として,MG対象の最短目標面700Aとバケット10の爪先の距離(目標面距離)の値が表示され,その目標面距離の値に応じたライトバー(警報)が点灯される。また,その目標面距離に応じた警告音(警報)が操作支援情報として通達装置53から出力され得る。つまり,この場合のように掘削作業をする際には,掘削動作によりバケット10が目標面の下方に侵入して現況地形を掘りすぎる可能性があるため,通達装置53から目標面距離に応じた警報(警告音及びライトバー)がオペレータに通達される。これにより現況地形の掘り過ぎを予防できる。
次に,図8の領域Bの目標面700Bと現況地形802Bを作業可能範囲D内に含めて油圧ショベル1で盛り土作業をしている場合には,目標面比較部62が作業機1Aに最も近い目標面700Bは現況地形802Bの上方に位置すると判定し,図18のステップSC106を経由してステップSC107が選択され通達内容変更フラグが立つ。このとき領域Cの目標面700Cと現況地形802Cは作業可能範囲Dの外なので図19のステップSD103が選択されMG対象目標面変更フラグは立たない。そのため,図11のフローに基づいてステップSB105,106,107が実行され,図13のように通達装置53を介して最短目標面700Bとバケット10の距離の数値の通達は行われるものの,警告音とライトバーによる警報の通達は行われない。つまり,この場合のように盛土作業をする際には,バケット10が目標面の下方に侵入しても現況地形を掘りすぎる可能性がないため,通達装置53から目標面距離に応じた警報は行われない。したがって従前のような不要な警報をオペレータが煩わしいと感じることがなくなる。
次に,図8の領域Bの目標面700Bと現況地形802Bと領域Cの目標面700Cと現況地形802Cを作業可能範囲D内に含めて且つ領域Bの近傍で作業している場合には,目標面比較部62が作業機1Aに最も近い目標面700Bは現況地形802Bの上方に位置すると判定し,図18のステップSC106を経由してステップSC107が選択され通達内容変更フラグが立つ。このとき領域Cの目標面700Cと現況地形802Cも作業可能範囲D内に存在するので図19のステップSD102が選択されMG対象目標面変更フラグも立つ。そのため,図11のフローに基づいてステップSB102,103,104が実行され,移動先目標面700Cとバケット10の距離に関する警報が図22のように通達装置53を介して通達される。その際,通達装置53には,MG対象の移動先目標面700Cとバケット10の爪先の距離(目標面距離)の値が表示される。これによりオペレータは移動先目標面700Cまでの距離を容易に把握できる。また,目標面距離の値に応じたライトバーが点灯され,目標面距離に応じた警告音が通達装置53から出力され得る。つまり,この場合のように領域Bで盛土作業する際には,盛土作業中のバケット10の動作により領域Bに隣接する領域Cの現況地形を掘りすぎる可能性があるため,通達装置53から目標面距離に応じた警報(警告音及びライトバー)が通達される。これにより現在の盛土作業領域Bに隣接した掘削作業領域Cの現況地形の掘り過ぎを予防できる。
以上のように,本実施形態の油圧ショベルでは,通達装置53が通達する操作支援情報の内容を目標面比較部62からのフラグ情報に応じて変化させることで,不要な操作支援情報を通達することなく,オペレータの掘削操作を支援することができる。例えば,現況地形800が目標面700の下方にある盛土をするような状況で,通達装置53から警告音が生じたり,ライトバー表示部531Dが点灯したりすることは,オペレータに煩わしさを感じさせるおそれがあるが,本実施形態によれば,そういった煩わしさの発生を防止できる。
<MCの動作と効果>
次に油圧ショベル1のアクチュエータ制御部81(制御コントローラ40)により行われるMCの動作について説明する。
図16のフローチャートにおいて,通達内容変更フラグが立っている場合,すなわち目標面比較部62が目標面700が現況地形800の上方に位置すると判定した場合には,制限値ayは,S430において目標面比較部が目標面700が現況地形800の下方に位置すると判定した場合(すなわち図17の場合)よりも低減された図21の値に設定される。すなわち制限値ayは図21に基づいて絶対値が充分大きな負の値に設定される。これにより,その後の処理で常にS450,S480,S490を経由してS530が選択されることになるので,バケット10の目標速度ベクトルTの垂直成分tyは,オペレータ操作によるバケット10の速度ベクトルBの垂直成分byに一致する。つまり,垂直成分tyを制限値ay以上の値に保持する強制ブーム上げ動作(すなわちMC)は実行されず、バケット10(作業機1A)の動作範囲は制限されないことになる。したがって,目標面700が現況地形の上方にある状況では不要な強制ブーム上げ動作は実行されないため,オペレータの意図しないMCの発動によりオペレータに違和感を与えることを防止できる。
一方,通達内容変更フラグが下りている場合,すなわち目標面比較部62が目標面700が現況地形800の下方に位置すると判定した場合には,S430で制限値ayが図17に基づいて設定される。これにより,制限値ay(目標面700と爪先の距離D)と,オペレータ操作によるバケット爪先の速度ベクトルBの垂直成分byとの関係に応じてMCによる強制ブーム上げ動作が適宜行われ,バケット10の爪先が目標面上または上方に保持される。例えば,爪先が目標面700の上方にあり,垂直成分byが負の場合(例えばアームクラウドによりバケット10が上方から目標面700に近づいている場合)にはS490を経由する。この場合,バケットの目標速度ベクトルTの垂直成分tyとしては制限値ayと垂直成分byのうち絶対値が小さい方が選択され,制限値ayが選択される場合には垂直成分cyの強制ブーム上げが適宜加えられる。また,爪先が目標面700の下方にあり,垂直成分byが負の場合(例えばアームクラウド操作により目標面700のさらに下方にバケット10を侵入させようとしている場合)には,S450,460を経由してS500が常に選択される。すなわち,目標速度ベクトルTの垂直成分tyは制限値ayに常に制限され,垂直成分cyの強制ブーム上げが常に加えられることになる。これにより,アームクラウド操作によりバケット10を下向きに動作をさせている間(垂直成分byが負の間)は,MCによりブーム上げ動作が適宜加えられてバケット10の爪先の高さが目標面700に近づくように保持されるので(すなわち,バケット10(作業機1A)の動作範囲は目標面700上及びその上方に制限されるので),目標面700に沿った掘削ができる。
<その他>
なお,本発明は,上記の実施の形態に限定されるものではなく,その要旨を逸脱しない範囲内の様々な変形例が含まれる。例えば,本発明は,上記の実施の形態で説明した全ての構成を備えるものに限定されず,その構成の一部を削除したものも含まれる。
上記では,図11のステップSB105では,最短目標面700とバケット10の爪先の距離情報とバケット10を基準としてMG対象目標面が位置する方向情報(図13の数値表示部531Bと矢印表示部531Cに表示される情報)を通達装置53に表示したが,後続するSB106及びSB107で通達が中止される警報音及びライトバーと同様にステップSB105では距離情報と方向情報も通達を中止しても良い。
また,上記では,図11に示した通り,通達内容変更フラグとMG対象目標面変更フラグの2つのフラグの状態に基づいて通達内容を変更したが,通達内容変更フラグのみに基づいて通達内容を変更してもよい。この場合,図11のステップSB100でYESと判定されたらステップSB105に進むようにフローチャートを構成すれば良い。このようにフローチャートを構成しても盛土作業時に不要な操作支援情報が通達されることを防止できる。
また,図21の制限値ayのグラフは一例に過ぎず,図17のグラフよりも距離Dごとの制限値ayを低減させたものであれば,強制ブーム上げ動作(すなわちMC)の発動の有無に係わらず利用可能である。
上記では通達内容変更フラグを利用したMGとMCを行う油圧ショベルについて説明したが,MGとMCの一方のみを行うように油圧ショベルを構成しても良い。
1A…フロント作業機,8…ブーム,9…アーム,10…バケット,30…ブーム角度センサ,31…アーム角度センサ,32…バケット角度センサ,40…制御コントローラ(制御装置),43…MG及びMC制御部,43a…操作量演算部,43b…姿勢演算部,43c…目標面演算部,44…電磁比例弁制御部,45…操作装置(ブーム,アーム),46…操作装置(バケット,旋回),50…作業装置姿勢検出装置,51…目標面設定装置,52a…オペレータ操作検出装置,53…表示装置,54,55,56…電磁比例弁,62…目標面比較部,81…アクチュエータ制御部,96…現況地形取得装置,374…通達制御部

Claims (9)

  1. 多関節型の作業機と,
    前記作業機を駆動する複数の油圧アクチュエータと,
    前記油圧アクチュエータの動作を指示する操作装置と,
    オペレータに操作支援情報を通達するための通達装置と,
    任意に設定した複数の目標面のうち所定の目標面と前記作業機の距離に基づいて前記操作支援情報を通達するか否かを制御する通達制御部を有する制御装置とを備える作業機械において,
    前記作業機の作業対象となる現況地形の位置を取得する現況地形取得装置をさらに備え,
    前記制御装置は,前記現況地形と前記作業機に最も近い目標面の位置と前記作業機に最も近い目標面に前記作業機の動作方向で隣接する目標面の位置とを比較して前記現況地形と前記作業機に最も近い目標面の位置との上下関係および、前記現況地形と前記作業機に最も近い目標面に前記作業機の動作方向で隣接する目標面の位置との上下関係を判定する目標面比較部を備え,
    前記通達制御部は,前記目標面比較部の判定結果に基づいて前記操作支援情報の内容を変更することを特徴とする作業機械。
  2. 請求項1の作業機械において,
    前記目標面比較部が,前記作業機に最も近い目標面が前記現況地形の下方に位置すると判定した場合,前記通達制御部は前記作業機に最も近い目標面と前記作業機の距離である目標面距離に基づいて前記操作支援情報を通達し,
    前記目標面比較部が,前記作業機に最も近い目標面が前記現況地形の上方に位置すると判定した場合,前記通達制御部は前記操作支援情報を通達しないことを特徴とする作業機械。
  3. 請求項1の作業機械において,
    前記目標面比較部が,前記作業機に最も近い目標面が前記現況地形の下方に位置すると判定した場合,前記通達制御部は前記作業機に最も近い目標面と前記作業機の距離である目標面距離に基づいて前記操作支援情報を通達し,
    前記目標面比較部が,前記作業機に最も近い目標面が前記現況地形の上方に位置すると判定し,かつ,前記作業機に最も近い目標面と前記作業機の動作方向で隣接する目標面が前記現況地形の下方に位置すると判定した場合,前記通達制御部は前記作業機に最も近い目標面と前記作業機の動作方向で隣接する目標面と前記目標面距離に基づいて前記操作支援情報を通達し,
    前記目標面比較部が,前記作業機に最も近い目標面が前記現況地形の上方に位置すると判定し,かつ,前記作業機に最も近い目標面と前記作業機の動作方向で隣接する目標面が前記現況地形の上方に位置すると判定した場合,前記通達制御部は前記操作支援情報を通達しないことを特徴とする作業機械。
  4. 請求項3の作業機械において,
    前記目標面比較部が,前記作業機に最も近い目標面が前記現況地形の上方に位置すると判定し,かつ,前記作業機に最も近い目標面と前記作業機の動作方向で隣接する目標面が前記現況地形の下方に位置すると判定した場合,前記通達制御部は,さらに,前記作業機に最も近い目標面と前記作業機の動作方向で隣接する目標面と前記作業機との距離を通達することを特徴とする作業機械。
  5. 請求項1の作業機械において,
    前記操作装置の操作時に,前記作業機の動作範囲が前記目標面上及びその上方に制限されるように前記油圧アクチュエータを制御するアクチュエータ制御部をさらに備え,
    前記アクチュエータ制御部によって制限される前記作業機の動作範囲は,前記目標面比較部の判定結果に基づいて変更されることを特徴とする作業機械。
  6. 請求項5の作業機械において,
    前記所定の制限値は,前記目標面比較部が前記作業機に最も近い目標面が前記現況地形の上方に位置すると判定した場合,前記目標面比較部が前記作業機に最も近い目標面が前記現況地形の下方に位置すると判定した場合よりも低減されることを特徴とする作業機械。
  7. 請求項1の作業機械において,
    前記目標面比較部は,前記現況地形と前記所定の目標面が前記作業機の可動範囲内に存在する場合,前記現況地形と前記所定の目標面の上下関係を判定することを特徴とする作業機械。
  8. 多関節型の作業機と、
    前記作業機を駆動する複数の油圧アクチュエータと,
    前記油圧アクチュエータの動作を指示する操作装置と,
    オペレータに操作支援情報を通達するための通達装置と,
    任意に設定した複数の目標面のうち所定の目標面と前記作業機との距離に基づいて前記操作支援情報を通達するか否かを制御する通達制御部を有する制御装置とを備える作業機械において,
    前記作業機の作業対象となる現況地形の位置を取得する現況地形取得装置をさらに備え,
    前記制御装置は,前記現況地形と前記所定の目標面の位置を比較して前記現況地形と前記所定の目標面の上下関係を判定する目標面比較部を備え,
    前記目標面比較部が,前記作業機に最も近い目標面が前記現況地形の下方に位置すると判定した場合,前記通達制御部は前記作業機に最も近い目標面と前記作業機との距離である目標面距離に基づいて警報音を出力し、
    前記目標面比較部が,前記作業機に最も近い目標面が前記現況地形の上方に位置すると判定した場合,前記通達制御部は前記作業機に最も近い目標面と前記作業機の距離に関わらず前記警報音の出力を中断することを特徴とする作業機械。
  9. バケットを含む多関節型の作業機と、
    前記作業機を駆動する複数の油圧アクチュエータと,
    前記油圧アクチュエータの動作を指示する操作装置と,
    オペレータに操作支援情報を通達するための表示装置と,
    任意に設定した複数の目標面のうち所定の目標面と前記作業機との距離に基づいて前記操作支援情報を通達するか否かを制御する通達制御部を有する制御装置とを備え,
    前記制御装置は,前記操作支援情報として前記バケットの画像と前記所定の目標面の画像とを前記表示装置に表示させる作業機械において,
    前記作業機の作業対象となる現況地形の位置を取得する現況地形取得装置をさらに備え,
    前記制御装置は,前記現況地形と前記所定の目標面の位置を比較して前記現況地形と前記所定の目標面の上下関係を判定する目標面比較部を備え,
    前記通達制御部は,前記目標面比較部の判定結果に基づいて,前記現況地形に対して前記所定の目標面の位置が上方にある場合と下方にある場合とで,前記操作支援情報として前記表示装置に表示させている前記所定の目標面の画像の表示態様を変更させることを特徴とする作業機械。
JP2017179134A 2017-09-19 2017-09-19 作業機械 Active JP6878226B2 (ja)

Priority Applications (6)

Application Number Priority Date Filing Date Title
JP2017179134A JP6878226B2 (ja) 2017-09-19 2017-09-19 作業機械
US16/631,505 US11230824B2 (en) 2017-09-19 2018-06-28 Work machine
CN201880055230.4A CN111051619B (zh) 2017-09-19 2018-06-28 作业机械
EP18858018.7A EP3686356B1 (en) 2017-09-19 2018-06-28 Work machinery
KR1020207005099A KR102399329B1 (ko) 2017-09-19 2018-06-28 작업 기계
PCT/JP2018/024609 WO2019058695A1 (ja) 2017-09-19 2018-06-28 作業機械

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017179134A JP6878226B2 (ja) 2017-09-19 2017-09-19 作業機械

Publications (2)

Publication Number Publication Date
JP2019052515A JP2019052515A (ja) 2019-04-04
JP6878226B2 true JP6878226B2 (ja) 2021-05-26

Family

ID=65810748

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017179134A Active JP6878226B2 (ja) 2017-09-19 2017-09-19 作業機械

Country Status (6)

Country Link
US (1) US11230824B2 (ja)
EP (1) EP3686356B1 (ja)
JP (1) JP6878226B2 (ja)
KR (1) KR102399329B1 (ja)
CN (1) CN111051619B (ja)
WO (1) WO2019058695A1 (ja)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108699814B (zh) * 2016-01-29 2022-04-12 住友建机株式会社 挖土机以及在挖土机的周围飞行的自主式飞行体
JP6633464B2 (ja) * 2016-07-06 2020-01-22 日立建機株式会社 作業機械
KR102493019B1 (ko) * 2017-08-09 2023-01-27 스미토모 겐키 가부시키가이샤 쇼벨, 쇼벨의 표시장치 및 쇼벨의 표시방법
JP7155516B2 (ja) * 2017-12-20 2022-10-19 コベルコ建機株式会社 建設機械
JP7372029B2 (ja) * 2018-06-29 2023-10-31 株式会社小松製作所 表示制御装置、表示制御システムおよび表示制御方法
JP7141894B2 (ja) * 2018-09-05 2022-09-26 日立建機株式会社 作業機械
JP7283910B2 (ja) * 2019-02-01 2023-05-30 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
US20210222405A1 (en) * 2020-01-16 2021-07-22 Deere & Company Intelligent hinged boom excavation systems
JP7401370B2 (ja) * 2020-03-24 2023-12-19 日立建機株式会社 作業機械
US11572671B2 (en) * 2020-10-01 2023-02-07 Caterpillar Sarl Virtual boundary system for work machine
JP7472751B2 (ja) 2020-10-02 2024-04-23 コベルコ建機株式会社 掘削位置決定システム
JP7009600B1 (ja) * 2020-12-07 2022-01-25 日立建機株式会社 作業機械
EP4317596A4 (en) * 2021-03-31 2024-10-02 Sumitomo Heavy Industries EXCAVATOR AND EXCAVATOR CONTROL DEVICE
WO2023090070A1 (ja) * 2021-11-19 2023-05-25 日本精機株式会社 作業支援システム、作業支援システムの制御方法、作業支援システムの制御プログラム
US11976444B2 (en) * 2021-12-03 2024-05-07 Deere & Company Work machine with grade control using external field of view system and method

Family Cites Families (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6366858B1 (en) 2000-06-30 2002-04-02 S. Mark Haugland Method of and apparatus for independently determining the resistivity and/or dielectric constant of an earth formation
JP4727068B2 (ja) * 2001-05-29 2011-07-20 株式会社トプコン 施工監視システム、施工管理方法
WO2004027164A1 (ja) * 2002-09-17 2004-04-01 Hitachi Construction Machinery Co., Ltd. 建設機械の掘削作業教示装置
KR20060064558A (ko) * 2003-09-02 2006-06-13 가부시키가이샤 고마쓰 세이사쿠쇼 시공 목표 지시 장치
JP5202667B2 (ja) * 2011-02-22 2013-06-05 株式会社小松製作所 油圧ショベルの位置誘導システム及びその制御方法
US20140064897A1 (en) * 2012-08-29 2014-03-06 Deere And Company Single stick operation of a work tool
JP5426742B1 (ja) * 2012-10-05 2014-02-26 株式会社小松製作所 掘削機械の表示システム及び掘削機械
JP5476450B1 (ja) 2012-11-19 2014-04-23 株式会社小松製作所 掘削機械の表示システム及び掘削機械
JP5789279B2 (ja) * 2013-04-10 2015-10-07 株式会社小松製作所 掘削機械の施工管理装置、油圧ショベルの施工管理装置、掘削機械及び施工管理システム
JP2014205655A (ja) 2013-04-15 2014-10-30 森 健司 森雪「シンシアリー(Sincerely)」
JP6675975B2 (ja) * 2014-04-25 2020-04-08 住友建機株式会社 建設機械及び建設機械の制御方法
KR101751164B1 (ko) * 2014-05-30 2017-06-26 가부시키가이샤 고마쓰 세이사쿠쇼 작업 기계의 제어 시스템, 작업 기계 및 작업 기계의 제어 방법
CN112359892A (zh) * 2014-06-20 2021-02-12 住友重机械工业株式会社 挖土机、挖土机的控制方法及地形数据更新方法
US9428885B2 (en) * 2014-09-15 2016-08-30 Trimble Navigation Limited Guidance system for earthmoving machinery
EP3235960B1 (en) * 2014-12-16 2019-11-13 Sumitomo (S.H.I.) Construction Machinery Co., Ltd. Controller and method for determining wear of a component of a shovel
WO2016148251A1 (ja) * 2015-03-19 2016-09-22 住友建機株式会社 ショベル
JP6316770B2 (ja) 2015-04-15 2018-04-25 日立建機株式会社 建設機械
EP3351692A4 (en) * 2015-09-15 2018-09-05 Sumitomo (S.H.I.) Construction Machinery Co., Ltd. Shovel
US10508417B2 (en) * 2015-12-18 2019-12-17 Komatsu Ltd. Construction information display device and method for displaying construction information
JP7216549B2 (ja) * 2016-09-29 2023-02-01 住友建機株式会社 ショベル
EP3594416B1 (en) * 2017-03-07 2022-07-27 Sumitomo (S.H.I.) Construction Machinery Co., Ltd. Shovel
US20210140147A1 (en) * 2017-06-13 2021-05-13 Volvo Construction Equipment Ab A working machine provided with an image projection arrangement

Also Published As

Publication number Publication date
KR102399329B1 (ko) 2022-05-18
US11230824B2 (en) 2022-01-25
WO2019058695A1 (ja) 2019-03-28
CN111051619B (zh) 2022-02-25
EP3686356B1 (en) 2022-08-17
EP3686356A1 (en) 2020-07-29
JP2019052515A (ja) 2019-04-04
EP3686356A4 (en) 2021-07-14
CN111051619A (zh) 2020-04-21
KR20200034762A (ko) 2020-03-31
US20200141091A1 (en) 2020-05-07

Similar Documents

Publication Publication Date Title
JP6878226B2 (ja) 作業機械
KR102097340B1 (ko) 작업 기계
JP6526321B2 (ja) 作業機械
KR102137469B1 (ko) 작업 기계
EP3733983B1 (en) Work machine
JP6752193B2 (ja) 作業機械
JP7093277B2 (ja) 作業機械
JP6957081B2 (ja) 作業機械
JP6732539B2 (ja) 作業機械
JP6823036B2 (ja) 建設機械の表示システムおよびその制御方法
JP2021067174A (ja) ショベル、ショベルのシステム
JP2021050602A (ja) 建設機械の表示システムおよびその制御方法
JP6860471B2 (ja) 作業機械
JP2020169558A (ja) 作業機械の制御装置及び制御方法
KR20220086672A (ko) 작업 기계의 제어 시스템, 작업 기계, 및 작업 기계의 제어 방법

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200310

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210112

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210315

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210428

R150 Certificate of patent or registration of utility model

Ref document number: 6878226

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150