[go: up one dir, main page]

JP6676825B2 - 作業機械 - Google Patents

作業機械 Download PDF

Info

Publication number
JP6676825B2
JP6676825B2 JP2019510391A JP2019510391A JP6676825B2 JP 6676825 B2 JP6676825 B2 JP 6676825B2 JP 2019510391 A JP2019510391 A JP 2019510391A JP 2019510391 A JP2019510391 A JP 2019510391A JP 6676825 B2 JP6676825 B2 JP 6676825B2
Authority
JP
Japan
Prior art keywords
bucket
target
excavation
current terrain
volume
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
JP2019510391A
Other languages
English (en)
Other versions
JPWO2019049248A1 (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
Publication of JPWO2019049248A1 publication Critical patent/JPWO2019049248A1/ja
Application granted granted Critical
Publication of JP6676825B2 publication Critical patent/JP6676825B2/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/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • E02F9/265Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
    • 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
    • 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/30Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
    • E02F3/32Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2203Arrangements for controlling the attitude of actuators, e.g. speed, floating function
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/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
    • 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)
  • Operation Control Of Excavators (AREA)

Description

本発明はマシンコントロールが実行可能な作業機械に関する。
油圧ショベルには,オペレータの掘削操作を補助する制御システムが備えられることがある。具体的には,操作装置を介して掘削操作(例えば,アームクラウドの指示)が入力された場合,目標面と作業機の先端(例えばバケットの爪先)の位置関係を基に,作業機(フロント作業機とも言う)の先端の位置が目標面上及びその上方の領域内に保持されるように,作業機を駆動するブームシリンダ,アームシリンダ及びバケットシリンダのうち少なくとも1つを強制的に動作させる制御(例えば,ブームシリンダを伸ばして強制的にブーム上げ動作を行う)を実行する制御システムがある。このような作業機先端の動き得る領域を制限すると,掘削面の仕上げ作業や法面の成形作業が容易になる。
例えば,特許文献1には,操作装置(操作レバー)からの信号を基にバケット先端の目標速度ベクトルを演算し,当該目標速度ベクトルにおける目標面に接近する方向のベクトル成分が目標面に近づくにつれて低減するようにブームシリンダを制御することで,目標面(設定領域の境界)の上方に設定した減速領域(設定領域)内にフロント作業機を保持するものが開示されている。以下では,この種の制御を「マシンコントロール(MC:Machine Control)」,「領域制限制御」または「(オペレータ操作に対する)介入制御」と称することがある。
ところで作業機械による掘削作業効率を向上する観点からは掘削動作ごとの掘削量を継続して最大化することが好ましい。特許文献2には,いわゆるベンチカット法による掘削をする場面において,作業機の1回の掘削動作でバケット内に収納されるべき掘削量(想定掘削量)を設定しておき,1回の掘削動作により掘削対象から当該想定掘削量が得られる領域を掘削領域Sとして決定し,当該掘削領域Sに基づいて次回の掘削動作を行う際の前記作業機械の作業位置Pwを算出する制御装置と,この制御装置が算出した前記作業機械の作業位置の情報を表示する表示装置とを備える作業機械の作業支援システムが開示されている。この技術では,次回の作業位置を表示装置に表示することで,作業機械が載っている掘削対象物の高さ(ベンチ高さ)Hが変化しても掘削動作ごとの掘削量を保持することを狙っている。
国際公開第1995/030059号パンフレット
特開2017−14726号公報
引用文献2では,次回の掘削動作で掘削対象物が掘削される掘削領域Sの断面積sbとベンチ高さHとに基づいて掘削領域Sを決定している。そして,掘削領域Sは平行四辺形であると仮定し,sb=H・Lsが成立することを利用して算出した距離(掘削量設定距離)Lsから次回の作業位置Pwを算出している。つまりベンチ高さHが規定の値であることを前提として作業位置Pwを算出しているが,次回の掘削動作に際して所定のベンチ高さHよりも作業機械に近い位置から掘削を開始してしまった場合には,制御装置が算出した作業位置Pwに作業機械が位置していてもその掘削量は想定掘削量(目標掘削量)に不足してしまい作業効率が低下するおそれがある。
この特許文献2の技術はベンチカット法による掘削を前提とするものであるが,特許文献1のように掘削動作によって目標面(平面)を生成する場合にも同様の指摘ができる。例えば,フロント作業機の前後方向において掘削開始点と掘削終了点を予め定めることで1回の掘削動作でバケットが移動する距離(掘削距離)を決定しておき,その1回の掘削動作で目標とする掘削量(目標掘削量(特許文献1の想定掘削量に相当))の掘削がなされるように現況地形から所定の深さ(掘削深さ)のところに目標面を設定し,その目標面に沿って掘削を行うことが考えられる。しかし,この方法では予め定めた掘削距離から掘削深さ(目標面)を決定しているため,掘削距離が変化した場合(例えば予め定めた掘削開始点から掘削が開始できなかった場合)に同じ目標面に基づいて掘削すると,目標掘削量に対して掘削量が過不足するおそれがある。
本発明の目的は,目標面を生成する掘削作業時のオペレータの負担を軽減しながら,掘削距離によらず目標掘削量(制限体積)に対する掘削量の過不足の発生を抑制できる作業機械を提供することにある。
本願は上記課題を解決する手段を複数含んでいるが,その一例を挙げるならば,バケット,アーム及びブームを有する作業機と,前記作業機を駆動する複数の油圧アクチュエータと,前記油圧アクチュエータの動作を指示する操作装置と,前記操作装置の操作時に,前記作業機の動作範囲が所定の第1目標面上及びその上方に制限されるように前記油圧アクチュエータを制御する制御装置とを備える作業機械において,前記制御装置は,現況地形の位置情報が記憶された記憶部と,前記バケットの爪先の位置を演算するバケット位置演算部と,掘削開始時に前記バケット位置演算部で演算された前記バケットの爪先の位置である第1位置,予め設定された掘削終了時の前記バケットの爪先の位置である第2位置,前記現況地形,前記第1目標面,及び,前記バケットの幅によって規定される掘削予想体積を演算する掘削予想体積演算部と,前記掘削予想体積が予め設定された制限体積を越える場合,前記第1目標面の上方に第2目標面を生成する目標面生成部とを備え,前記目標面生成部は,前記第1位置,前記第2位置,前記現況地形,前記第2目標面,及び,前記バケットの幅によって規定される掘削体積が前記制限体積に近づく位置に前記第2目標面を生成し,前記制御装置は,前記第2目標面が生成された場合,前記作業機の動作範囲が前記第2目標面上及びその上方に制限されるように前記油圧アクチュエータを制御することとする。
本発明によれば,掘削動作ごとに掘削距離が変化しても目標掘削量が保持されるように目標面が設定されるので,目標掘削量(制限体積)に対する掘削量の過不足の発生を抑制でき掘削作業の効率を向上できる。
油圧ショベルの構成図。 油圧ショベルの制御コントローラを油圧駆動装置と共に示す図。 図2中のフロント制御用油圧ユニット160の詳細図。 図1の油圧ショベルにおける座標系および目標面(第1目標面)を示す図。 油圧ショベルの制御コントローラ40のハードウェア構成図。 油圧ショベルの制御コントローラ40の機能ブロック図。 図6中のMG・MC制御部43の機能ブロック図。 現況地形800と,目標面(第1目標面)700と,油圧ショベル1の関係を表す側面図。 補正量dと第1目標面700と第2目標面700Aと油圧ショベル1との関係を表す側面図。 バケット爪先P4と目標面700,700Aとの位置関係を示す図。 目標面距離Dと速度補正係数kとの関係を表すグラフ。 バケット先端の速度ベクトルV0を表す図。 MG/MC制御部43による目標面設定のフローチャート。 MG/MC制御部43によるMCのフローチャート。 表示装置53aの構成図の一例を示す図。 他の実施形態のMG/MC制御部43Aの機能ブロック図。 バケット爪先の位置情報に基づく現況地形更新部43aaによる現況地形の更新を表す模式図。 第1目標面700がショベル座標に対して傾斜している場合の第2目標面700Aの生成方法を表す模式図。 第1目標面700が傾斜の異なる複数面によって構成されている場合の第2目標面700Aの生成方法を表す模式図。
以下,本発明の実施形態について図面を用いて説明する。なお,以下では,作業機の先端の作業具(アタッチメント)としてバケット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に設けられた運転室16内には,走行右レバー23a(図2)を有し走行右油圧モータ3a(下部走行体11)を操作するための操作装置47a(図2)と,走行左レバー23b(図2)を有し走行左油圧モータ3b(下部走行体11)を操作するための操作装置47b(図2)と,操作右レバー1a(図2)を共有しブームシリンダ5(ブーム8)及びバケットシリンダ7(バケット10)を操作するための操作装置45a,46a(図2)と,操作左レバー1b(図2)を共有しアームシリンダ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の運転室16に配置されたゲートロックレバー(不図示)の位置検出器と電気的に接続している。ゲートロックレバーのポジションは位置検出器で検出され,その位置検出器からロック弁39に対してゲートロックレバーのポジションに応じた信号が入力される。ゲートロックレバーのポジションがロック位置にあればロック弁39が閉じてポンプライン170が遮断され,ロック解除位置にあればロック弁39が開いてポンプライン170が開通する。つまり,ポンプライン170が遮断された状態では操作装置45,46,47による操作が無効化され,旋回,掘削等の動作が禁止される。
操作装置45,46,47は,油圧パイロット方式であり,パイロットポンプ48から吐出される圧油をもとに,それぞれオペレータにより操作される操作レバー1,23の操作量(例えば,レバーストローク)と操作方向に応じたパイロット圧(操作圧と称することがある)を発生する。このように発生したパイロット圧は,コントロールバルブユニット(図示せず)内の対応する流量制御弁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の基底部を原点POとし,上部旋回体12における鉛直方向にZ軸,水平方向にX軸を設定した。また,X軸とZ軸によって右手系で規定される方向をY軸とする。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方向位置として,以下の式(1)(2)で表すことができる。
Figure 0006676825
Figure 0006676825
また,油圧ショベル1は,図1に示すように,上部旋回体12に一対のGNSS(Global Navigation Sattelite System)アンテナ14A,14Bを備えている。GNSSアンテナ14からの情報に基づき,グローバル座標系における油圧ショベル1の位置,またバケット10の位置を算出することができる。
図5は本実施形態に係る油圧ショベルが備えるマシンガイダンス(Machine Guidance:MG)ならびにマシンコントロール(Machine Control:MC)システムの構成図である。
本システムでのフロント作業機1AのMCとしては,操作装置45a,45b,46aが操作され,かつ,任意に設定された目標面700(図4参照)の上方に設定された所定の閉領域である減速領域(第1領域)600に作業機1Aが位置する場合,予め定めた条件に従って作業機1Aを動作させる制御が実行される。具体的には,減速領域600では,作業機1Aの先端部(例えばバケット10の爪先)が目標面700に近づくほど作業機1Aの先端部の速度ベクトルにおける目標面700に接近する方向のベクトル成分が低減するように複数の油圧アクチュエータ5,6,7のうち少なくとも1つを制御することがMCとして行われる(詳細は後述)。油圧アクチュエータ5,6,7の制御は,該当する流量制御弁15a,15b,15cに制御信号(例えば,ブームシリンダ5を伸ばして強制的にブーム上げ動作を行う)を強制的に出力することで行われる。このMCによりバケット10の爪先が目標面700の下方に侵入することが防止されるので,オペレータの技量の程度に関わらず目標面700に沿った掘削が可能となる。一方,減速領域600の上方に減速領域600と隣接して設定された非減速領域(第2領域)620に作業機1Aが位置する場合にはMCは実行されず,オペレータの操作通りに作業機1Aが動作する。図4における点線650は,減速領域600と非減速領域620の境界線である。
なお,本実施形態では,MC時のフロント作業機1Aの制御点を,油圧ショベルのバケット10の爪先(作業機1Aの先端)に設定しているが,制御点は作業機1Aの先端部分の点であればバケット爪先以外にも変更可能である。例えば,バケット10の底面やバケットリンク13の最外部も選択可能であり,目標面700から最も距離の近いバケット10上の点を適宜制御点とする構成を採用しても良い。また,本稿ではMCを,操作装置45,46の非操作時に作業機1Aの動作を制御コントローラ(制御装置)40により制御する「自動制御」に対して,操作装置45,46の操作時にのみ作業機1Aの動作を制御コントローラ40により制御する「半自動制御」と称することがある。
また,本システムでのフロント作業機1AのMGとしては,例えば図15に示すように,目標面700と,作業機1A(例えば,バケット10)との位置関係を表示装置53aに表示する処理が行われる。
図5のシステムは,作業機姿勢検出装置50と,目標面設定装置51と,オペレータ操作検出装置52aと,運転室16内に設置され目標面700と作業機1Aの位置関係を表示可能な表示装置53aと,作業機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の制御ということもできる。
<制御コントローラ>
図5において制御コントローラ40は,入力インターフェース91と,プロセッサである中央処理装置(CPU)92と,記憶装置であるリードオンリーメモリ(ROM)93及びランダムアクセスメモリ(RAM)94と,出力インターフェース95とを有している。入力インターフェース91には,作業機姿勢検出装置50である角度センサ30〜32及び傾斜角センサ33からの信号と,目標面700を設定するための装置である目標面設定装置51からの信号と, 現況地形800を取得する現況地形取得装置96からの信号が入力され,CPU92が演算可能なように変換する。ROM93は,後述するフローチャートに係る処理を含めMC及びMGを実行するための制御プログラムと,当該フローチャートの実行に必要な各種情報等が記憶された記録媒体であり,CPU92は,ROM93に記憶された制御プログラムに従って入力インターフェース91及びROM93,RAM94から取り入れた信号に対して所定の演算処理を行う。出力インターフェース95は,CPU92での演算結果に応じた出力用の信号を作成し,その信号を表示装置53aに出力すること表示装置53aを作動させられることができる。
なお,図5の制御コントローラ40は,記憶装置としてROM93及びRAM94という半導体メモリを備えているが,記憶装置であれば特に代替可能であり,例えばハードディスクドライブ等の磁気記憶装置を備えても良い。
図6は,制御コントローラ40の機能ブロック図である。制御コントローラ40は,MG及びMC制御部(MG/MC制御部)43と,電磁比例弁制御部44と,表示制御部374aを備えている。
<MG/MC制御部43>
MG/MC制御部43は,操作装置45a,45b,46aの操作時に,予め定めた条件に従って複数の油圧アクチュエータ5,6,7の少なくとも1つをMCする。本実施形態のMG/MC制御部43は,操作装置45a,45b,46aの操作時に,目標面700の位置と,フロント作業機1Aの姿勢及びバケット10の爪先の位置と,操作装置45a,45b,46aの操作量とに基づいて,目標面700上またはその上方にバケット10の爪先(制御点)が位置するようにブームシリンダ5(ブーム8)及びアームシリンダ6(アーム9)の少なくとも一方の動作を制御するMCを実行する。MG/MC制御部43は,各油圧シリンダ5,6,7の流量制御弁15a,15b,15cの目標パイロット圧を演算し,その演算した目標パイロット圧を電磁比例弁制御部44に出力する。
図7は図6中のMG/MC制御部43の機能ブロック図である。MG/MC制御部43は,現況地形更新部43aと,現況地形記憶部43bと,目標面記憶部43cと,バケット位置演算部43dと,目標速度演算部43eと,掘削予想体積演算部43fと,目標面生成部43gと,距離演算部43hと,補正速度演算部43iと,目標パイロット圧演算部43jを備えている。
現況地形記憶部43bは,油圧ショベル周囲の現況地形の位置情報(現況地形データ)を記憶する。例えば,現況地形データは,グローバル座標系において適宜のタイミングで現況地形取得装置96によって取得された3次元の座標データを有する点群である。
現況地形更新部43aは,掘削予想体積演算部43fにより掘削予想体積Va(後述)が演算されるとき,現況地形取得装置96によって取得された現況地形800の位置情報によって現況地形記憶部43bに記憶された現況地形の位置情報を更新する。
目標面記憶部43cは,目標面設定装置51からの情報に基づき演算された目標面(第1目標面)700の位置情報(目標面データ)を記憶する。本実施形態では,図4に示すように,3次元の目標面を作業機1Aが移動する平面(作業機の動作平面)で切断した断面形状を目標面700(2次元の目標面)として利用する。なお,図4の例では目標面700は1つだが,目標面が複数存在する場合もある。目標面が複数存在する場合には,例えば,作業機1Aから最も近いものを目標面と設定する方法や,バケット爪先の下方に位置するものを目標面とする方法や,任意に選択したものを目標面とする方法等がある。
バケット位置演算部43dは,作業機姿勢検出装置50からの情報に基づき,ローカル座標系(ショベル座標系)におけるフロント作業機1Aの姿勢と,バケット10の爪先の位置を演算する。既述のとおり,バケット10の爪先位置情報(Xbk,Zbk)(バケット位置データ)は,式(1)及び式(2)により演算できる。また,グローバル座標系における,車体基準位置P0の座標と車体傾斜角度θに基づいて,現況地形データと,設計面データとを車体基準位置P0を原点とした車体座標系に変換することが可能である。以下,車体座標系として例を説明する。
掘削予想体積演算部43fは,現況地形データと,目標面データと,バケット位置データと,予め設定した掘削終了位置(後述の基準位置x0)に基づいて掘削予想体積Vaを演算する。掘削予想体積Vaは,バケット爪先位置のX座標(後述のx1)と,予め設定された掘削終了時のバケット爪先位置(掘削終了位置)のX座標(後述の基準位置x0)と,現況地形800と,目標面700と,バケット10の幅によって規定された閉領域の体積である。図8に現況地形800と,目標面(第1目標面)700と,油圧ショベル1の関係を表す側面図を示す。掘削予想体積演算部43fは,ショベル座標系のX方向において掘削終了位置として予め設定された基準位置x0と,バケット位置演算部43dによって演算されたバケット座標のXの値x1(=Xbk)の範囲内にある土砂の体積Va(図8中でドットを付した領域の体積)を演算する。x1は,式(1)から得られるバケット爪先位置のX座標であるXbkである。基準位置x0は,掘削終了時のバケット爪先位置のX座標であり,走行体11近傍の任意の値を設定できる。本実施形態では,基準位置x0は,上部旋回体12と下部走行体11の前方向を揃えたときの下部走行体11における最前部のX座標に設定されている。このとき,土砂の体積(掘削予想体積)Vaは下記の式(3)によって求めることができる。本稿では,基準位置x0(掘削終了位置)を,掘削開始時のバケット爪先位置(掘削開始位置)である第1位置に対して「第2位置」と称することがある。
Figure 0006676825
ここで,式(3)中のzは,同一のX,Y座標を有する現況地形上の点と目標面上の点のZ座標の偏差である。また,wはバケット10の幅である。本実施形態では,計算の簡略化のために,バケット幅wを使用しているが,バケット幅内にある現況地形の点群をY軸方向にも積分することにより,掘削予想体積Vaを求めてもよい。掘削予想体積演算部43fは掘削予想体積Vaを目標面生成部43gに出力する。
目標面生成部43gは,掘削予想体積Vaが予め設定された制限体積Vbを越える場合,第1目標面700を補正量dだけ上方にオフセットした新たな目標面(第2目標面)700Aを生成する。その際,目標面生成部43gは,バケット爪先の位置(x1=Xbk)と,予め設定された掘削終了位置(x0)と,現況地形800と,第2目標面700Aと,バケット幅wによって規定された閉領域の体積が制限体積Vb以下になるように補正量dを設定して第2目標面700Aの高さを決定する。図9に補正量dと第1目標面700と第2目標面700Aと油圧ショベル1との関係を表す側面図を示す。制限体積Vbは,バケット10で保持可能な掘削物の最大体積以下の値から任意に設定することができ,通常はバケット容量の2倍以下の値となる。また,制限体積Vbは,作業効率の観点から作業機1Aの1回の掘削動作でバケット10内に収納されるべき掘削体積の目標値(目標掘削量)と換言できる。
ところで,掘削予想体積Vaから制限体積Vbを減算することで,掘削予想体積Vaを制限体積Vbに減らすために必要な体積(補正体積と称する)Vcを下記の式(4)により演算することが可能である。
Figure 0006676825
補正体積Vcと,掘削距離Lと,バケット幅wと,補正量dの関係は下記の式(5)で表すことができる。
Figure 0006676825
ここで,掘削距離Lは,バケット爪先位置と掘削終了位置のX座標の偏差であり,バケット位置情報x1から基準位置x0を減算することで求めることができる。上記の式(5)を変形することで補正量dは下記の式(6)のように求めることができる。
Figure 0006676825
目標面生成部43gは,バケット爪先位置が現況地形800から所定の範囲内にあり,操作装置45bを介してアーム6のクラウド操作(アーム引き指令)が入力されたときにバケット位置演算部43dが演算したバケット爪先の位置(x1)を掘削開始位置(第1位置)として掘削距離Lを算出し,その掘削距離Lと補正体積Vcとバケット幅wと上記の式(6)により求められた補正量dだけ第1目標面700を上方にオフセットして第2目標面700Aを生成する。また,掘削予想体積Vaが制限体積Vb以下であった場合は,目標面生成部43gは第2目標面700Aを生成せず,MG/MC制御部43は第1目標面700に基づいてMCを実行する。
距離演算部43h,バケット位置データに基づいて,第1目標面700と第2目標面700Aのうちバケット爪先P4(図10参照)に近い方の目標面(MC対象目標面)とバケット爪先P4との距離(目標面距離)Dを演算する。すなわち,目標面距離Dは,目標面生成部43gによって第2目標面700Aが生成された場合にはP4と第2目標面700Aとの距離となり,目標面生成部43gによって第2目標面700Aが生成されなかった場合にはP4と第1目標面700との距離となる。図10にバケット爪先P4とMC対象目標面700,700Aとの位置関係を示す図を示す。バケット爪先P4からMC対象目標面700,700Aに下した垂線の足と,バケット位置座標との距離がMC対象目標面700,700Aとバケット先端P4との目標面距離Dである。
目標速度演算部43eは,オペレータ操作検出装置52aからの入力を基に操作装置45a,45b,46a(操作レバー1a,1b)の操作量を算出し,その操作量に基づいてブームシリンダ5と,アームシリンダ6と,バケットシリンダ7の目標動作速度を演算する。操作装置45a,45b,46aの操作量は,圧力センサ70,71,72の検出値から算出できる。なお,圧力センサ70,71,72による操作量の算出は一例に過ぎず,例えば各操作装置45a,45b,46aの操作レバーの回転変位を検出する位置センサ(例えば,ロータリーエンコーダ)で当該操作レバーの操作量を検出しても良い。また,操作量から動作速度を算出する構成に代えて,各油圧シリンダ5,6,7の伸縮量を検出するストロークセンサを取り付け,検出した伸縮量の時間変化を基に各シリンダの動作速度を算出する構成も適用可能である。
補正速度演算部43iは,距離演算部43hから出力された目標面距離Dに基づいて,バケット先端P4の速度ベクトルV0における目標面(目標面距離Dの算出に利用したMC目標面、すなわち目標面700または目標面700A)に垂直な成分(鉛直成分)V0zの補正係数kを演算する。
図11に目標面距離Dと速度補正係数kとの関係を表すグラフを示す。バケット先端P4が目標面よりも上方にある場合に目標面距離Dは正であるとし,目標面侵入方向の速度を正とした場合に,目標面距離Dが所定の距離d1から減少するにつれて,速度補正係数kは1から減少する。
図12にバケット先端の速度ベクトルV0を表す図を示す。補正速度演算部43iは目標速度演算部43eから出力されたアクチュエータ速度に基づいてバケット先端P4の速度ベクトルV0を演算する。そして,そのバケット速度ベクトルV0を目標面の鉛直成分V0zと水平成分V0xに分解し,鉛直成分V0zに補正係数kを乗算することにより補正速度V1zとする。補正速度V1zと元の速度ベクトルV0の水平成分V0xによってつくられる速度ベクトルが,バケット先端P4の補正後の速度ベクトルV1となる。これにより,バケット先端P4が目標面に近づいて距離Dがゼロに近づくほどその速度ベクトルの鉛直方向の速度はゼロに近づく。これにより目標面に沿ってバケット先端P4が動くMCが実行される。また,バケット先端P4が目標面から離れる方向に動作する場合(すなわち,鉛直成分V0zが上向きの場合)には,距離Dにかかわらず速度補正係数kを常に1とする。これによりブーム上げ動作が減速されることはない。
目標パイロット圧演算部(制御信号演算部)43jは,バケット先端P4の補正後の速度ベクトルV1(V1z,V0x)が出力可能な各油圧シリンダ5,6,7の目標速度を演算する。このとき,ブーム上げとアームクラウドの減速との組合せで先端速度ベクトルV0を目標速度ベクトルV1に変換するMCを行うようにソフトが設計されていると,ブームシリンダ5の伸長方向のシリンダ速度とアームシリンダ6の伸長方向のシリンダ速度が演算される。そして,目標パイロット圧演算部43jは,算出した各シリンダ5,6,7の目標速度を基に各油圧シリンダ5,6,7の流量制御弁15a,15b,15cへの目標パイロット圧(制御信号)を演算し,各油圧シリンダ5,6,7の流量制御弁15a,15b,15cへの目標パイロット圧を電磁比例弁制御部44に出力する。
<電磁比例弁制御部44>
電磁比例弁制御部44は,目標パイロット圧演算部43jから出力される各流量制御弁15a,15b,15cへの目標パイロット圧を基に,各電磁比例弁54〜56への指令を演算する。なお,オペレータ操作に基づくパイロット圧(第1制御信号)と,アクチュエータ制御部81で算出された目標パイロット圧が一致する場合には,該当する電磁比例弁54〜56への電流値(指令値)はゼロとなり,該当する電磁比例弁54〜56の動作は行われない。
<表示制御部374a>
表示制御部374aは,MG/MC制御部43から入力されるフロント作業機1Aの姿勢情報,バケット10の爪先の位置情報,目標面700の位置情報に基づいて,目標面700と,作業機1A(バケット10の爪先)との位置関係を表示装置53aに表示する処理を実行する。これにより図15に示すように表示装置53aの表示画面に,目標面700と作業機1A(バケット10の爪先)の位置関係が表示される。
<MG/MC制御部43による目標面設定のフローチャート>
図13にMG/MC制御部43による目標面設定のフローチャートを示す。MG/MC制御部43は所定の制御周期で処理を開始し,現況地形更新部43aは,現況地形取得装置96によって取得された最新の現況地形の位置情報によって現況地形記憶部43bに記憶された現況地形の位置情報を更新する(手順S1)。
次にバケット位置演算部43dは,作業機姿勢検出装置50から出力される情報を基にバケット爪先位置(Xbk,Zbk)を演算する(手順S2)。
次に掘削予想体積演算部43fは手順S2で演算されたバケット爪先位置を基準として所定の範囲内にある現況地形データと第1目標面データを取得する(手順S3)。そして掘削予想体積演算部43fはバケット爪先位置と現況地形データと第1目標面データから掘削予想体積Vaを演算する(手順S4)。
次に目標面生成部43gは掘削予想体積Vaが予め設定された制限体積Vbを越えるか否かを判定する(手順S5)。この手順S5で掘削予想体積Vaが制限体積Vbを越えないと判定された場合(すなわち掘削予想体積Vaが制限体積Vb以下の場合),目標面生成部43gは第2目標面700Aを生成せず,第1目標面700がMCの目標面(MC対象目標面)となる(手順S6)。
一方,手順S5で掘削予想体積Vaが制限体積Vbを越えると判定された場合は目標面生成部43g目標面の補正量dを演算して(手順S7)次の手順S8に進む。
手順S8では,目標面生成部43gはバケット爪先位置(Xbk,Zbk)が現況地形800から所定の範囲内に存在するか否かを判定する。この判定で当該所定の範囲内にバケット爪先が存在すると判定された場合は手順S9に進み,当該所定の範囲外に存在すると判定された場合は手順S6に進む。
手順S9では,目標面生成部43gは操作装置45bを介してアーム引き指令(アームクラウド操作)が入力されたか否かを判定する。この判定でアーム引き指令が入力されていないと判定された場合には手順S6に進み,アーム引き指令が入力されていると判定された場合には第1目標面700の上方に補正量d分だけオフセットした面を第2目標面700Aとして生成し(手順S10),手順S11に進む。手順S10により第2目標面700AがMCの目標面(MC対象目標面)となる。
手順S11では,目標面生成部43gは,アーム引き指令の入力が終了したか否かの判定を行う。ここでアーム引き指令が継続している間は手順S10で補正した第2目標面700AのMCでの利用を維持する。一方,アーム引き指令が終了した場合は第2目標面700AのMCでの利用を終了する。
<MG/MC制御部43によるMCのフローチャート>
図14はMG/MC制御部43によるMCのフローチャートを示す。MG/MC制御部43は操作装置45a,45b,46aのいずれかがオペレータにより操作されると図13の処理を開始し,バケット位置演算部43dは作業機姿勢検出装置50からの情報に基づきバケット爪先位置(バケット位置データ)を演算する(手順S12)。
手順S13では,距離演算部43hが,第1目標面700と第2目標面700Aのうち図13のフローでMC対象目標面と設定された目標面の位置情報(目標面データ)を目標面生成部43gから取得する。そして,手順S14では,距離演算部43hが,手順S12で演算したバケット位置データと,手順S13で取得した目標面データに基づいて目標面距離Dを演算する。
手順S15では,補正速度演算部43iが,手順S14で演算された目標面距離Dに基づいて,バケット先端P4の速度ベクトルV0におけるMC対象目標面に垂直な成分V0zの補正係数k(−1≦k≦1)を演算する。
手順S16では,目標速度演算部43eが,オペレータ操作検出装置52aからの入力を基に操作装置45a,45b,46a(操作レバー1a,1b)の操作量を算出し,その操作量に基づいてブームシリンダ5と,アームシリンダ6と,バケットシリンダ7の目標動作速度を演算する。
手順S17では,補正速度演算部43iが,手順S16で演算された各アクチュエータ速度に基づいてバケット先端P4の速度ベクトルV0を演算する。そして,そのバケット速度ベクトルV0を目標面の鉛直成分V0zと水平成分V0xに分解し,鉛直成分V0zに補正係数kを乗算することにより補正速度V1zとする。補正速度演算部43iは,補正速度V1zと元の速度ベクトルV0の水平成分V0xを合成してバケット先端P4の補正後の速度ベクトルV1を演算する。
手順S18では,目標パイロット圧演算部43jが,手順S17で演算された補正後の速度ベクトルV1(V1z,V0x)を基に各油圧シリンダ5,6,7の目標速度を演算する。そして,目標パイロット圧演算部43jは,算出した各シリンダ5,6,7の目標速度を基に各油圧シリンダ5,6,7の流量制御弁15a,15b,15cへの目標パイロット圧を演算し,各油圧シリンダ5,6,7の流量制御弁15a,15b,15cへの目標パイロット圧を電磁比例弁制御部44に出力する。これにより目標面700上またはその上方にバケット爪先が位置するように油圧シリンダ5,6,7の少なくとも1つの動作を制御するMCが実行される。
<動作・効果>
上記のように構成される油圧ショベル1では,図13のフローチャートにより,そのときのバケット爪先位置(x1=Xd)と予め定めた掘削終了位置(x0(第2位置))と現況地形800と第1目標面700とバケット幅wによって規定される掘削予想体積Vaが所定の制御周期で演算される(手順S1−S4)。そして,掘削予想体積Vaが制限体積Vbより大きい場合には,そのときのバケット爪先位置(x1)と,予め定めた掘削終了位置(x0)と,現況地形800と,第11目標面700を補正量dだけ上方にセットバックした第2目標面700Aと,バケット幅wとによって規定される体積が制限体積Vbになるように補正量dが演算される(手順S5−S7)。
ところで,通常,油圧ショベル1で掘削作業を開始する場合には,ブーム5の上げ・下げ操作及びアーム6のダンプ操作により現況地形上で車体1Bから離れた位置にバケット爪先を移動させた状態で操作装置45bを介してアーム引き指令(アーム6のクラウド操作)を入力することで掘削作業を開始する。すなわち,アーム引き指令が入力された時には,バケット爪先位置は現況地形上に在りその位置から掘削作業が開始するとみなすことができる。そこで本実施形態では,掘削予想体積Vaが制限体積Vbより大きい場合に,手順S9でアーム引き指令の入力の有無を判定し,アーム引き指令の入力が有った場合にはそのときのバケット爪先位置を掘削開始位置(第1位置)とみなして第2目標面700Aを生成することとした(手順S10)。
これにより,掘削開始時(アームクラウド操作の開始時)に掘削予想体積Vaが制限体積Vbより大きい場合には,掘削開始位置(第1位置)に合わせて,掘削予想体積がVbとなる位置に第2目標面700Aが生成され,その第2目標面700AがMC対象目標面に設定される(図13で手順S10を通過するルートの処理が行われる)。一方,掘削予想体積Vaが制限体積Vb以下の場合には,第1目標面700がMC対象目標面に設定される(図13で手順S6を通過するルートの処理が行われる)。
このように掘削予想体積Vaに応じてMC対象目標面が適宜設定され得る状況下で操作装置45bを介してアームクラウド操作を入力して作業機1Aで掘削作業を実施すると,図14のフローに基づきMG/MC制御部43は,アームクラウド操作によりバケット10の爪先が減速領域600内を移動する間,爪先がMC対象目標面に近づくほど爪先の速度ベクトルの鉛直成分(目標面700に垂直な成分)が低減するように油圧アクチュエータ5,6,7の少なくとも1つを制御するMCを実行する。これによりMC対象目標面上では爪先の速度ベクトルの垂直成分はゼロになるため,オペレータはアームクラウド操作を入力するだけでMC対象目標面に沿った掘削が可能となり,掘削作業時のオペレータの負担が軽減する。そしてこの掘削作業時には,図13のフローチャートにより,常に掘削量が制限体積Vb以下になるように掘削開始時のバケット爪先位置(第1位置)に応じて目標面が決定されるため,各掘削動作で掘削開始位置(第1位置)が異なっていても(すなわち掘削距離Lが掘削の都度変化しても)実際の掘削量が制限体積Vbを超過することを防止できる。
すなわち,本実施形態によれば,掘削開始時の油圧ショベル1の姿勢に基づいて掘削体積Vaが演算され,実際の掘削量が常に制限体積Vb以下になるようにMC対象目標面が生成されるため,掘削距離Lが変化する場合でも適切な位置にMC対象目標面を生成でき,実際の掘削量が制限体積Vb(例えば、バケット最大容量)を超過することを防止できる。またその際,バケット10がMC対象目標面の下方に侵入することが防止され,当該MC対象目標面に沿ってバケット10が動作するようにフロント作業機1Aが制御されるため,掘削作業におけるオペレータの操作負担も軽減される。すなわち,例えば第1目標面を作業対象物の最終形状を示す設計面として設定し,制限体積Vbをバケット最大容量に設定すれば,1回掘削動作の掘削量を常にバケット最大容量以下に保持した状態で設計面を傷つけることなく掘削作業を実行できる。
なお,上記の実施形態では,油圧ショベル1に搭載した現況地形取得装置96で現況地形を取得する例を説明したが,例えば,現況地形取得装置としてレーザスキャナを搭載したドローンから現況地形情報を取得する場合のように,油圧ショベル1とは独立した現況地形取得装置を用意しておき,当該現況地形取得装置が取得した現況地形情報を入力して利用しても良い。
<他の実施形態(現況地形更新部の変形例)>
次に本発明の他の実施形態について説明する。本実施形態の油圧ショベルは制御コントローラ(具体的には現況地形更新部の処理内容)が先の実施形態と異なっており,他の部分は同じである。そのため,先の実施形態と同じ部分についての説明は省略し,主に異なる部分についてのみ説明する。
図16は本実施形態のMG/MC制御部43Aの機能ブロック図である。本実施形態のMG/MC制御部43Aは現況地形更新部43aaを備えている点で先の実施形態のMG/MC制御部43と異なる。
現況地形更新部43aaは,現況地形記憶部43bに記憶された現況地形の位置情報とバケット位置演算部43dで演算されるバケット爪先の位置情報を入力しており,バケット位置演算部43dで演算されたバケット爪先の位置が現況地形記憶部43bに記憶された現況地形の位置よりも下方にある場合,バケット位置演算部43dで演算されたバケット爪先の位置情報によって現況地形記憶部43bに記憶された現況地形の位置情報を更新する。一方,バケット位置演算部43dで演算されたバケット爪先の位置が現況地形記憶部43bに記憶された現況地形の位置よりも上方にある場合には,現況地形記憶部43bに記憶された現況地形の位置情報の更新は行わない。すなわち,本実施形態では,現況地形を掘削した際のバケット爪先の軌跡を掘削後の現況地形としてみなして現況地形データを更新している。
図17にバケット爪先の位置情報に基づく現況地形更新部43aaによる現況地形の更新を表す模式図を示す。ある水平方向座標x’におけるバケット高さ方向の座標z1と現況地形の高さ方向の座標z0を比較して,z1がz0よりも下方向にあった場合はz1を新たな現況地形データとして更新する。
このようにバケット爪先位置情報を現況地形の更新に利用することにより,掘削毎に現況地形取得装置96が現況地形データを取得する必要がなくなり,現況地形データの取得に要する時間を短縮することが可能である。また,一旦現況地形データを取得しておけば,以後は現況地形更新部43aaの更新機能で逐次現況地形データが更新されるので,現況地形取得装置96を油圧ショベル1に搭載することを省略することも可能となる。
<その他>
なお,上記の説明における第1目標面700は,最終的な施工形状を規定する設計面であると考えても良い。
また,第1目標面700がショベル座標に対して傾斜している場合には,次のように補正量dを算出して第2目標面700Aを生成することができる。図18に第1目標面700がショベル座標に対して傾斜している場合の第2目標面700Aの生成方法を表す模式図を示す。第1目標面700が水平方向に対してθだけ傾斜している場合,第1目標面方向の掘削距離L’は,ショベル座標における水平方向の距離Lを用いて下記の式(7)のように求められる。
Figure 0006676825
この第1目標面方向の掘削距離L’を式(6)のLとして用いることで,第1目標面700が傾斜していない場合と同様に第1目標面700の補正量dを計算することが可能である。
また,第1目標面700が傾斜の異なる複数の面によって構成されている場合には,次のように補正量dを算出して第2目標面700Aを生成することができる。図19に第1目標面700が傾斜の異なる複数面によって構成されている場合の第2目標面700Aの生成方法を表す模式図を示す。この図のように第1目標面700が複数面から構成されている場合,第1目標面700の傾斜が切り替わる点の水平方向座標をx2とし,第1目標面700が水平の範囲の掘削予想体積Va2と第1目標面700が傾斜している範囲の掘削予想体積Va1の和に対して,第1目標面700が水平の範囲の掘削距離L2と第1目標面700が傾斜している範囲の掘削距離L1’の和(L2+L1’)を式(6)のLとして用いることで,補正量dを計算することが可能である。
また,上記の実施形態では,元々の目標面(第1目標面700)の位置に基づいて演算される掘削予想体積Vaが所望の制限体積Vbを越える場合,当該元々の目標面(第1目標面700)の上方に新たな目標面(第2目標面700A)を生成し,当該新たな目標面の位置に基づいて演算される体積が制限体積Vbに近づくようにすることで課題の解決を図ったが,1回の掘削動作で掘削される掘削予想体積が制限体積Vbに一致する位置または制限体積Vbに近づく位置に直接的に目標面を設定するように油圧ショベルを構成しても良い。
すなわち,バケット10,アーム9及びブーム8を有する作業機1Aと,作業機1Aを駆動する複数の油圧アクチュエータ5,6,7と,油圧アクチュエータ5,6,7の動作を指示する操作装置45a,45b,46aと,現況地形800の位置情報が記憶された現況地形記憶部43b,及び,バケット10の爪先の位置を演算するバケット位置演算部43dを有する制御コントローラ43とを備える油圧ショベルにおいて,制御コントローラ43に,掘削開始時にバケット位置演算部43dで演算されたバケット爪先位置である第1位置,予め設定された掘削終了時のバケット爪先位置である第2位置,現況地形800,目標面,及び,バケットの幅wによって規定される掘削体積が予め設定された制限体積Vbに近づく位置に前記目標面を生成する目標面生成部43gをさらに備え,制御コントローラ43は,操作装置45a,45b,46aの操作時に,作業機1Aの動作範囲が前記目標面上及びその上方に制限されるように油圧アクチュエータ5,6,7を制御することとしても良い。
なお,補正係数kは図11に規定したものに限らず,目標面距離Dが正の範囲でゼロに近づくほど速度ベクトルの鉛直成分V0zがゼロに近づくように補正する係数であればその他の値でも構わない。
なお,本発明は,上記の実施の形態に限定されるものではなく,その要旨を逸脱しない範囲内の様々な変形例が含まれる。例えば,本発明は,上記の実施の形態で説明した全ての構成を備えるものに限定されず,その構成の一部を削除したものも含まれる。また,ある実施の形態に係る構成の一部を,他の実施の形態に係る構成に追加又は置換することが可能である。
1A…フロント作業機,5…ブームシリンダ,6…アームシリンダ,7…バケットシリンダ,8…ブーム,9…アーム,10…バケット,30…ブーム角度センサ,31…アーム角度センサ,32…バケット角度センサ,40…制御コントローラ(制御装置),43…MG・MC制御部,43a…現況地形更新部,43b…現況地形記憶部(記憶部),43c…目標面記憶部,43d…バケット位置演算部,43e…目標速度演算部,43f…掘削予想体積演算部,43g…目標面生成部,43h…距離演算部,43i…補正速度演算部,43j…目標パイロット圧演算部,44…電磁比例弁制御部,45…操作装置(ブーム,アーム),46…操作装置(バケット,旋回),50…作業装置姿勢検出装置,51…目標面設定装置,53a…表示装置,54,55,56…電磁比例弁,96…現況地形取得装置,374a…表示制御部,700…第1目標面,700A…第2目標面,800…現況地形

Claims (5)

  1. バケット,アーム及びブームを有する作業機と,
    前記作業機を駆動する複数の油圧アクチュエータと,
    前記油圧アクチュエータの動作を指示する操作装置と,
    前記操作装置の操作時に,前記作業機の動作範囲が所定の第1目標面上及びその上方に制限されるように前記油圧アクチュエータを制御する制御装置とを備える作業機械において,
    前記制御装置は,
    現況地形の位置情報が記憶された記憶部と,
    前記バケットの爪先の位置を演算するバケット位置演算部と,
    掘削開始時に前記バケット位置演算部で演算された前記バケットの爪先の位置である第1位置,予め設定された掘削終了時の前記バケットの爪先の位置である第2位置,前記現況地形,前記第1目標面,及び,前記バケットの幅によって規定される掘削予想体積を演算する掘削予想体積演算部と,
    前記掘削予想体積が予め設定された制限体積を越える場合,前記第1目標面の上方に第2目標面を生成する目標面生成部とを備え,
    前記目標面生成部は,前記第1位置,前記第2位置,前記現況地形,前記第2目標面,及び,前記バケットの幅によって規定される掘削体積が前記制限体積に近づく位置に前記第2目標面を生成し,
    前記制御装置は,前記第2目標面が生成された場合,前記作業機の動作範囲が前記第2目標面上及びその上方に制限されるように前記油圧アクチュエータを制御することを特徴とする作業機械。
  2. 請求項1の作業機械において,
    前記第1位置は,前記操作装置を介して前記アームのクラウド操作が入力されたときに前記バケット位置演算部が演算した前記バケットの爪先の位置であることを特徴とする作業機械。
  3. 請求項1の作業機械において,
    前記現況地形の位置情報を取得する現況地形取得装置をさらに備え,
    前記制御装置は,前記掘削予想体積演算部により前記掘削予想体積が演算されるとき,前記現況地形取得装置によって取得された前記現況地形の位置情報によって前記記憶部に記憶された前記現況地形の位置情報を更新する現況地形更新部をさらに備えることを特徴とする作業機械。
  4. 請求項1の作業機械において,
    前記制御装置は,前記バケット位置演算部で演算された前記バケットの爪先の位置が前記記憶部に記憶された前記現況地形の位置よりも下方にある場合,前記バケット位置演算部で演算された前記バケットの爪先の位置情報によって前記記憶部に記憶された前記現況地形の位置情報を更新する現況地形更新部をさらに備えることを特徴とする作業機械。
  5. 請求項1の作業機械において,
    前記制限体積は,前記バケットの容量の2倍以下であることを特徴とする作業機械。
JP2019510391A 2017-09-06 2017-09-06 作業機械 Active JP6676825B2 (ja)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2017/032171 WO2019049248A1 (ja) 2017-09-06 2017-09-06 作業機械

Publications (2)

Publication Number Publication Date
JPWO2019049248A1 JPWO2019049248A1 (ja) 2019-11-07
JP6676825B2 true JP6676825B2 (ja) 2020-04-08

Family

ID=65633737

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019510391A Active JP6676825B2 (ja) 2017-09-06 2017-09-06 作業機械

Country Status (6)

Country Link
US (2) US20200217050A1 (ja)
EP (1) EP3680395B1 (ja)
JP (1) JP6676825B2 (ja)
KR (1) KR102125282B1 (ja)
CN (1) CN109757113B (ja)
WO (1) WO2019049248A1 (ja)

Families Citing this family (26)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102659077B1 (ko) * 2018-03-27 2024-04-18 스미도모쥬기가이고교 가부시키가이샤 쇼벨
JP6946226B2 (ja) * 2018-03-29 2021-10-06 株式会社小松製作所 作業車両の制御システム、方法、及び作業車両
JP7188940B2 (ja) * 2018-08-31 2022-12-13 株式会社小松製作所 制御装置、積込機械、および制御方法
EP3882400A4 (en) * 2018-11-14 2022-01-12 Sumitomo Heavy Industries, Ltd. BLADE AND METHODS OF CONTROL OF BLADE
CN110020628B (zh) * 2019-04-10 2021-01-05 刘家祺 基于面部检测的坐姿检测方法、系统、设备及存储介质
DE102019207165A1 (de) * 2019-05-16 2020-11-19 Robert Bosch Gmbh Verfahren zur Berechnung eines Aushubvolumens
JP7146701B2 (ja) * 2019-06-27 2022-10-04 日立建機株式会社 油圧ショベル
US11828040B2 (en) * 2019-09-27 2023-11-28 Topcon Positioning Systems, Inc. Method and apparatus for mitigating machine operator command delay
JP7245141B2 (ja) * 2019-09-30 2023-03-23 日立建機株式会社 油圧ショベル
JP7246294B2 (ja) * 2019-11-26 2023-03-27 コベルコ建機株式会社 計測装置、及び建設機械
AU2020294261B2 (en) 2020-01-16 2025-11-13 Caterpillar Global Mining Equipment Llc System and method to automatically position a machine in an operating configuration
US11572671B2 (en) * 2020-10-01 2023-02-07 Caterpillar Sarl Virtual boundary system for work machine
KR102731910B1 (ko) 2020-10-19 2024-11-20 히다찌 겐끼 가부시키가이샤 작업 기계
CN116601362A (zh) * 2020-12-23 2023-08-15 沃尔沃建筑设备公司 挖掘机和用于控制挖掘机的方法和装置
US20220299318A1 (en) * 2021-03-19 2022-09-22 Topcon Corporation Surveying system, surveying method, and storage medium storing surveying program
WO2022210613A1 (ja) * 2021-03-30 2022-10-06 住友重機械工業株式会社 ショベル及びショベルの制御装置
JP7559667B2 (ja) * 2021-04-26 2024-10-02 コベルコ建機株式会社 目標軌跡生成システム
US20230097563A1 (en) * 2021-09-28 2023-03-30 Deere & Company System and method for blade control on a utility vehicle
JP7610023B2 (ja) * 2021-09-30 2025-01-07 日立建機株式会社 作業機械
CN114411867B (zh) * 2022-02-18 2023-03-10 北京合众鼎新信息技术有限公司 一种挖掘工程作业结果的三维图形渲染展示方法及装置
JP2024047145A (ja) * 2022-09-26 2024-04-05 株式会社小松製作所 作業機械の制御システム、作業機械、及び作業機械の制御方法
CN116084481A (zh) * 2023-01-09 2023-05-09 三一重机有限公司 一种挖掘机的作业方法、装置及系统
WO2024195267A1 (ja) * 2023-03-17 2024-09-26 日立建機株式会社 作業機械の制御システム
JPWO2025126682A1 (ja) * 2023-12-15 2025-06-19
WO2025135204A1 (ko) * 2023-12-18 2025-06-26 볼보 컨스트럭션 이큅먼트 에이비 건설기계의 자동 주행 보조 시스템 및 건설기계의 자동 주행 보조 제어 방법
WO2025135203A1 (ko) * 2023-12-18 2025-06-26 볼보 컨스트럭션 이큅먼트 에이비 건설기계의 자동 트렌치 시스템 및 건설기계의 자동 트렌치 제어 방법

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100196669B1 (ko) 1994-04-28 1999-06-15 세구치 류이치 건설기계의 영역제한 굴삭제어장치
JP3609164B2 (ja) * 1995-08-14 2005-01-12 日立建機株式会社 建設機械の領域制限掘削制御の掘削領域設定装置
JP3713120B2 (ja) * 1997-03-11 2005-11-02 新キャタピラー三菱株式会社 建設機械の制御装置
JP2000291076A (ja) * 1999-04-01 2000-10-17 Tokai Rika Co Ltd パワーショベル
SE526913C2 (sv) * 2003-01-02 2005-11-15 Arnex Navigation Systems Ab Förfarande i form av intelligenta funktioner för fordon och automatiska lastmaskiner gällande kartläggning av terräng och materialvolymer, hinderdetektering och styrning av fordon och arbetsredskap
JP6522441B2 (ja) * 2015-06-29 2019-05-29 日立建機株式会社 作業機械の作業支援システム
CN108431338B (zh) * 2015-12-28 2020-12-11 住友建机株式会社 铲土机

Also Published As

Publication number Publication date
KR102125282B1 (ko) 2020-06-23
WO2019049248A1 (ja) 2019-03-14
US20220259834A1 (en) 2022-08-18
EP3680395A4 (en) 2021-06-16
EP3680395A1 (en) 2020-07-15
CN109757113A (zh) 2019-05-14
US20200217050A1 (en) 2020-07-09
US11851854B2 (en) 2023-12-26
KR20190039710A (ko) 2019-04-15
JPWO2019049248A1 (ja) 2019-11-07
CN109757113B (zh) 2021-03-16
EP3680395B1 (en) 2022-08-03

Similar Documents

Publication Publication Date Title
JP6676825B2 (ja) 作業機械
KR102024701B1 (ko) 작업 기계
JP6526321B2 (ja) 作業機械
JP6633464B2 (ja) 作業機械
CN107208404B (zh) 工程机械的显示系统
KR102118386B1 (ko) 작업 기계
KR102154581B1 (ko) 작업 기계
KR102520407B1 (ko) 작업 기계
CN115917089A (zh) 作业机械
KR20200028993A (ko) 작업 기계
CN107109820A (zh) 工作装置控制装置以及作业机械
KR20210115007A (ko) 작업 기계
KR102680653B1 (ko) 작업 기계의 제어 시스템, 작업 기계, 및 작업 기계의 제어 방법
CN109511267A (zh) 作业机械以及作业机械的控制方法
JP7401370B2 (ja) 作業機械
JP7401715B2 (ja) 作業機械
KR102491288B1 (ko) 작업 기계
WO2020065739A1 (ja) 作業機械

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190219

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200312

R150 Certificate of patent or registration of utility model

Ref document number: 6676825

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150