JPWO2019008767A1 - 作業車両の制御システム、制御方法、及び作業車両 - Google Patents

作業車両の制御システム、制御方法、及び作業車両 Download PDF

Info

Publication number
JPWO2019008767A1
JPWO2019008767A1 JP2019528324A JP2019528324A JPWO2019008767A1 JP WO2019008767 A1 JPWO2019008767 A1 JP WO2019008767A1 JP 2019528324 A JP2019528324 A JP 2019528324A JP 2019528324 A JP2019528324 A JP 2019528324A JP WO2019008767 A1 JPWO2019008767 A1 JP WO2019008767A1
Authority
JP
Japan
Prior art keywords
dump
work vehicle
segments
candidate positions
controller
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2019528324A
Other languages
English (en)
Other versions
JP6861814B2 (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.)
Komatsu Ltd
Original Assignee
Komatsu 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 Komatsu Ltd filed Critical Komatsu Ltd
Publication of JPWO2019008767A1 publication Critical patent/JPWO2019008767A1/ja
Application granted granted Critical
Publication of JP6861814B2 publication Critical patent/JP6861814B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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
    • E02F9/261—Surveying the work-site to be treated
    • E02F9/262—Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B66—HOISTING; LIFTING; HAULING
    • B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075—Constructional features or details
    • B66F9/12—Platforms; Forks; Other load supporting or gripping members
    • B66F9/19—Additional means for facilitating unloading
    • B66F9/195—Additional means for facilitating unloading for pushing the load
    • 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/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • 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/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/7609—Scraper blade mounted forwardly of the tractor on a pair of pivoting arms which are linked to the sides of the tractor, e.g. bulldozers
    • 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/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/80—Component parts
    • E02F3/84—Drives or control devices therefor, e.g. hydraulic drive 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/2025—Particular purposes of control systems not otherwise provided for
    • E02F9/2045—Guiding machines along a predetermined path
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria

Landscapes

  • Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Civil Engineering (AREA)
  • Mining & Mineral Resources (AREA)
  • General Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Transportation (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Geology (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

コントローラは、ダンピングエリアの縁の形状を示すダンピングエリアデータを取得する。コントローラは、ダンピングエリアの物体の形状を示すマテリアルデータを取得する。コントローラは、マテリアルデータに基づいて物体を区画した複数のセグメントを決定する。コントローラは、複数のセグメントと複数のダンプ候補位置との組み合わせによりダンプ作業におけるダンプ位置を決定する。

Description

本発明は、作業車両の制御システム、制御方法、及び作業車両に関する。
作業車両によって行われる作業にダンピングエリアでのダンプ作業がある。ダンプ作業は、例えば鉱山で掘削された土砂などの物体をダンピングエリアの崖まで搬送し、崖下に排出する作業である。ダンプ作業では、ダンピングエリア上に物体が積み上げられ、積み上げられた物体が、ブルドーザなどの作業車両によって、崖から押し出されて、崖下に落とし込まれる。
特開２００７−１６４２７９号
ダンピングエリアに積み上げられた物体の総量は、作業車両のブレードの最大容量を超えることが多い。また、ダンピングエリアに積み上げられた物体と、ダンピングエリアの崖の縁との間には隙間がある。従って、ダンプ作業では、積み上げられた物体の一部を作業車両によって削り、作業車両を崖の縁まで走行させ、削り取った物体を縁から押し出すという作業を繰り返し行う必要がある。
しかし、崖の縁の形状は均一ではないため、物体と縁との間の距離は、場所によって異なる。従って、どのように作業車両を走行させるかによって、作業効率に影響を与える。熟練したオペレータであれば、どのように作業車両を走行させればよいか経験により取得しているが、経験の少ないオペレータにとっては、効率よく作業を行うことは容易ではない。
本発明の課題は、作業車両によってダンプ作業を効率よく且つ容易に行うことにある。
第１の態様に係る制御システムは、ダンピングエリアの縁から物体を押し出すダンプ作業を行うための作業車両の制御システムであって、コントローラを備える。コントローラは、次の処理を行うようにプログラムされている。コントローラは、ダンピングエリアの縁の形状を示すダンピングエリアデータを取得する。コントローラは、ダンピングエリアの物体の形状を示すマテリアルデータを取得する。コントローラは、マテリアルデータに基づいて物体を区画した複数のセグメントを決定する。コントローラは、ダンピングエリアの縁に沿う複数のダンプ候補位置を決定する。コントローラは、複数のセグメントと複数のダンプ候補位置との組み合わせにより、ダンプ作業におけるダンプ位置を決定する。
第２の態様に係る制御方法は、ダンピングエリアの縁から物体を押し出すダンプ作業を行うための作業車両の制御方法であって、次の処理を含む。第１の処理は、ダンピングエリアの縁の形状を示すダンピングエリアデータを取得することである。第２の処理は、ダンピングエリアの物体の形状を示すマテリアルデータを取得することである。第３の処理は、マテリアルデータに基づいて物体を区画した複数のセグメントを決定することである。第４の処理は、ダンピングエリアの縁に沿う複数のダンプ候補位置を決定することである。第５の処理は、複数のセグメントと複数のダンプ候補位置との組み合わせを決定することである。第６の処理は、組み合わせに従ってダンプ作業を行うように、作業車両を制御することである。
本発明では、ダンピングエリアの物体が複数のセグメントに分けられ、ダンピングエリアの崖の縁に沿って複数のダンプ候補位置が決定される。そして、複数のセグメントと複数のダンプ候補位置との組み合わせにより、ダンプ位置が決定される。従って、決定されたダンプ位置に従って作業車両を移動させることで、効率よく且つ容易にダンプ作業を行うことができる。
実施形態に係る作業車両を示す側面図である。 作業車両の駆動系と制御システムとの構成を示すブロック図である。 ダンピングエリアを上方から見た図である。 ダンピングエリアを側方から見た図である。 作業車両の自動制御の処理を示すフローチャートである。 ダンピングエリアデータとマテリアルデータとの一例を示す図である。 複数のセグメントと複数のダンプ候補位置との一例を示す図である。 変数行列の解と、それにより決定された走行パスの一例を示す図である。 変数行列の解と、それにより決定された走行パスの一例を示す図である。 変数行列の解と、それにより決定された走行パスの一例を示す図である。 他の実施形態に係る作業車両の斜視図である。 他の実施形態に係る制御システムを示すブロック図である。 他の実施形態に係る自動制御の処理を示すフローチャートである。
以下、実施形態に係る作業車両1について、図面を参照しながら説明する。図1は、実施形態に係る作業車両1を示す側面図である。本実施形態に係る作業車両1は、ブルドーザである。作業車両1は、車体11と、走行装置12と、作業機13と、を備えている。
車体11は、運転室14とエンジン室15とを有する。運転室14には、図示しない運転席が配置されている。エンジン室15は、運転室14の前方に配置されている。走行装置12は、車体11の下部に取り付けられている。走行装置12は、左右一対の履帯16を有している。なお、図1では、左側の履帯16のみが図示されている。履帯16が回転することによって、作業車両1が走行する。
作業機13は、車体11に取り付けられている。作業機13は、リフトフレーム17と、ブレード18と、リフトシリンダ19と、を有する。リフトフレーム17は、上下に動作可能に車体11に取り付けられている。リフトフレーム17は、ブレード18を支持している。
ブレード18は、車体11の前方に配置されている。ブレード18は、リフトフレーム17の上下動に伴って上下に移動する。リフトシリンダ19は、車体11とリフトフレーム17とに連結されている。リフトシリンダ19が伸縮することによって、リフトフレーム17は、上下に回転する。
図2は、作業車両1の駆動系2と制御システム3との構成を示すブロック図である。図2に示すように、駆動系2は、エンジン22と、油圧ポンプ23と、動力伝達装置24と、を備えている。
油圧ポンプ23は、エンジン22によって駆動され、作動油を吐出する。油圧ポンプ23から吐出された作動油は、油圧アクチュエータ25に供給される。油圧アクチュエータ25は、上述したリフトシリンダ19を含む。なお、図2では、1つの油圧ポンプ23が図示されているが、複数の油圧ポンプが設けられてもよい。
油圧アクチュエータ25と油圧ポンプ23との間には、制御弁26が配置されている。制御弁26は、比例制御弁であり、油圧ポンプ23からリフトシリンダ19に供給される作動油の流量を制御する。なお、制御弁26は、圧力比例制御弁であってもよい。或いは、制御弁26は、電磁比例制御弁であってもよい。
動力伝達装置24は、エンジン22の駆動力を走行装置12に伝達する。動力伝達装置24は、例えば、HST（Hydro Static Transmission）であってもよい。或いは、動力伝達装置24は、例えば、トルクコンバーター、或いは複数の変速ギアを有するトランスミッションであってもよい。
制御システム3は、コントローラ31と、位置検出装置32と、通信装置33と、記憶装置34とを備える。コントローラ31は、取得したデータに基づいて作業車両1を制御するようにプログラムされている。コントローラ31は、例えばCPU等の処理装置を含む。なお、コントローラ31は、一体に限らず、複数のコントローラに分かれていてもよい。
位置検出装置32は、作業車両1の位置を検出する。位置検出装置32は、例えば、GPS（Global Positioning System）などのGNSS(Global Navigation Satellite System)レシーバを含む。コントローラ31は、作業車両1の現在位置を示す現在位置データを位置検出装置32から取得する。
通信装置33は、作業車両1の外部の機器と無線或いは有線を介して接続される。通信装置33は、作業車両1の外部の機器と通信を行う。例えば、通信装置33は、外部の測量装置35と通信する。測量装置35は、例えば、レーザ測量を用いる装置であってもよい。或いは、測量装置35は、カメラを含み、作業現場の画像データによって測量を行ってもよい。測量装置35は、例えば、UAV(Unmanned Aerial Vehicle)に搭載され、航空測量を行う装置であってもよい。
記憶装置34は、例えばメモリーと補助記憶装置とを含む。記憶装置34は、例えば、RAM、或いはROMなどであってもよい。記憶装置34は、半導体メモリ、或いはハードディスクなどであってもよい。記憶装置34は、非一時的な（non-transitory）コンピュータで読み取り可能な記録媒体の一例である。記憶装置34は、プロセッサによって実行可能であり作業車両1を制御するためのコンピュータ指令を記録している。また、記憶装置34は、通信装置33を介して取得した外部の機器からのデータを記録する。
コントローラ31は、エンジン22、油圧ポンプ23、動力伝達装置24、及び制御弁26に指令信号を出力することで、これらの装置を制御する。例えば、コントローラ31は、油圧ポンプ23の容量、及び、制御弁26の開度を制御することで、油圧アクチュエータ25を動作させる。これにより、作業機13を動作させることができる。
コントローラ31は、エンジン22の回転速度、及び、動力伝達装置24を制御することで、作業車両1を走行させる。例えば、動力伝達装置24がHSTの場合、コントローラ31は、HSTの油圧ポンプの容量と油圧モータの容量とを制御する。動力伝達装置24が複数の変速ギアを有するトランスミッションの場合、コントローラ31は、ギアシフト用のアクチュエータを制御する。また、コントローラ31は、左右の履帯16に速度差が生じるように、動力伝達装置24を制御することで、作業車両1を旋回させる。
次に、コントローラ31によって実行される、作業車両1の自動制御について説明する。コントローラ31は、エンジン22及び動力伝達装置24を制御することで、作業車両1を自動的に走行させることができる。また、コントローラ31は、エンジン22、油圧ポンプ23、及び制御弁26を制御することで、作業機13を自動的に制御することができる。
以下、作業車両1によって行われるダンプ作業の自動制御について説明する。図3は、ダンピングエリアを上方から見た図である。図4は、ダンピングエリアを側方から見た図である。図3に示すように、ダンピングエリアでは、ダンプトラック等の搬送手段100が、土砂等の物体を崖の縁200の近くまで搬送して排出する。それにより、ダンピングエリアの縁200の近くには、積み上げられた物体M1−M6の山（パイル）が配置される。ダンプ作業は、作業車両1が、ブレード18によって物体M1−M6のパイルの一部を削り、ダンピングエリアの縁200から押し出して落とし込む作業である。
図5は、作業車両1の自動制御の処理を示すフローチャートである。図5に示すように、ステップS101では、コントローラ31は、現在位置データを取得する。コントローラ31は、位置検出装置32から現在位置データを取得する。
ステップS102では、コントローラ31は、ダンピングエリアデータを取得する。図6に示すように、ダンピングエリアデータは、ダンピングエリアの縁200の形状及び位置を示す。例えば、ダンピングエリアの形状はポリゴン近似によって表現される。測量装置35は、ダンピングエリアの測量を行うことで、ダンピングエリアデータを取得する。コントローラ31は、測量装置35からダンピングエリアデータを取得する。
ステップS103では、コントローラ31は、マテリアルデータを取得する。図6に示すように、マテリアルデータは、ダンピングエリアの物体M1の形状及び位置を示す。例えば、物体M1の形状は、ポリゴン近似によって表現される。測量装置35は、ダンピングエリアの測量を行うことで、マテリアルデータを取得する。コントローラ31は、測量装置35からマテリアルデータを取得する。
ステップS104では、コントローラ31は、物体M1のセグメント化を行う。図7に示すように、コントローラ31は、マテリアルデータに基づいて物体M1を区画した複数のセグメントSGを決定する。コントローラ31は、マテリアルデータに基づいて物体M1の体積を演算する。コントローラ31は、各セグメントSGの体積が、所定の目標体積と一致するように、複数のセグメントSGの境界となるセグメント面SPの位置を決定する。それにより、図7に示すように、コントローラ31は、第1〜第n番目のセグメントSGを決定する。なお、図7では、各セグメントSGに“1”〜“n”のセグメント番号を付している。
セグメント面SPは、例えば、作業車両1の進行方向に沿う。ただし、セグメント面SPの方向が互いに異なってもよい。目標体積は、ブレード18の最大容量に基づいて決定されてもよい。例えば、目標体積は、ブレード18の最大容量に所定の割合を乗じた値であってもよい。
ステップS105では、コントローラ31は、ダンプ候補位置DPを決定する。ここでは、コントローラ31は、ダンピングエリアの縁200に沿う複数のダンプ候補位置DPを決定する。例えば、コントローラ31は、ダンピングエリアの縁200に沿って一定距離ごとの位置を、それぞれダンプ候補位置DPとして決定する。それにより、図7に示すように、コントローラ31は、第１〜第m番目のダンプ候補位置DPを決定する。なお、図7では、各ダンプ候補位置DPに“1”〜“m”のダンプ位置番号を付している。
第１番目のダンプ候補位置DPは、第１番目のセグメントSGに最も近い縁200上の位置である。なお、ダンプ候補位置DPの数mは、セグメントSGの数nに基づいて決定されてもよい。複数のダンプ候補位置DPの間隔は一定でなくてもよい。
ステップS106では、コントローラ31は、制御モードデータを取得する。制御モードデータは、複数の制御モードのなかから選択されている制御モードを示す。制御モードは、例えば、オペレータによって選択されてもよい。或いは、コントローラ31によって自動的に選択されてもよい。選択されている制御モードに応じて、セグメントSGとダンプ候補位置DPとの組み合わせを決定する際に考慮される要求条件が設定される。複数の制御モードは、最短距離モードと、均等分配モードと、目標分配モードとを含む。制御モード及び要求条件については後述する。
ステップS107では、コントローラ31は、セグメントSGの分配を決定する。ここでは、コントローラ31は、複数のセグメントSGと複数のダンプ候補位置DPとの組み合わせを決定する。コントローラ31は、上述した要求条件を満たしつつ、ダンプ作業のコストが最小となる複数のセグメントSGと複数のダンプ候補位置DPとの組み合わせを決定する。
本実施形態では、コストは、セグメントSGをダンプ候補位置DPまで運ぶための作業車両1の移動距離である。言い換えれば、コストは、セグメントSGとダンプ候補位置DPとの間の距離であってもよい。従って、コントローラ31は、移動距離の総和が最小となる複数のセグメントSGと複数のダンプ候補位置DPとの組み合わせを決定する。後述するように、本実施形態では、コントローラ31は、線形計画法により複数のセグメントSGと複数のダンプ候補位置DPとの組み合わせを決定する。
ステップS108では、コントローラ31は、走行パスを決定する。ここでは、コントローラ31は、ステップS107で決定されたセグメントSGとダンプ候補位置DPとの組み合わせに従って、走行パスを決定する。コントローラ31は、複数のダンプ候補位置DPのうち、組み合わせに選ばれたダンプ候補位置DPをダンプ位置DPとして決定する。そして、図8に示すように、コントローラ31は、組み合わされたセグメントSGとダンプ位置DPとを結ぶように走行パスPHを決定する。なお、図8では走行パスの一部のみに符号“PH”を付して他の走行パスの符号は省略されている。セグメントの符号“SG”とダンプ位置の符号“DP”についても同様である。
ステップS109では、コントローラ31は、ダンプ作業を実行するように作業車両1を制御する。ここでは、コントローラ31は、ステップS108で決定された走行パスPHに沿って作業車両1を移動させる。コントローラ31は、現在位置データと走行パスPHとに基づいて、作業車両1を制御する。
次に、セグメントSGとダンプ候補位置DPとの組み合わせを決定するための処理について説明する。本実施形態では、整数線形計画（Integer Linear Programming；ILP）を用いてセグメントSGとダンプ候補位置DPとの組み合わせを決定する。整数線形計画では、全ての変数が整数である。整数線形計画の定式は以下の式(1)で示される。
Figure 2019008767
ただし、
Figure 2019008767
である。
Cは、コスト行列である。Xは変数行列である。a, bは、変数行列Xの要求条件を示す定数行列である。各行列の次元は以下の(4)式で示される。
Figure 2019008767
nは、セグメントSGの数である。mは、ダンプ候補位置DPの数である。pは要求条件の数である。コスト行列Cは以下の式(5)(6)で示される。
Figure 2019008767
cki（ｋ=1,2,...n）(i=1,2,...m)は、k番目のセグメントSGからi番目のダンプ候補位置DPまでのコストである。本実施形態では、k番目のセグメントSGからi番目のダンプ候補位置DPまでの移動距離がコストとして設定される。移動距離は、例えば、ユークリッド距離によって決定される。ただし、移動距離は、ユークリッド距離以外の手法によって決定されてもよい。
変数行列Xは、以下の式(7)〜(9)で示される。
Figure 2019008767
xki（k=1,2,...n）（i=1,2,...n）は、k番目のセグメントSGからi番目のダンプ候補位置DPまでの走行パスの決定値であり、“1”又は“0”である。“1”は、k番目のセグメントSGからi番目のダンプ候補位置DPまでの走行パスが選択されることを意味し、“0”はk番目のセグメントSGからi番目のダンプ候補位置DPまでの走行パスが選択されないことを意味する。すなわち、変数行列Xの解は、セグメントSGとダンプ候補位置DPとの組み合わせを示している。
図8は、変数行列Xの解の一例と、その場合に決定される走行パスPHを示す図である。図8に示すように、x13 = 1である。これは、1番目のセグメントSGから3番目のダンプ候補位置DPまでの走行パスが選択されることを意味している。また、x11 = 0である。これは、1番目のセグメントSGから1番目のダンプ候補位置DPまでの走行パスが選択されないことを意味している。
図8は、上述した制御モードのうち最短距離モードでのセグメントSGの分配の例を示している。図8に示す例では、ダンプ候補位置DPの数mは10であり、セグメントSGの数nは10である。最短距離モードでは、上述した式(1)の目的関数から、以下の式(10)で示される第1の要求条件に従うと共に移動距離の総和が最小となるように、セグメントSGとダンプ候補位置DPとの組み合わせの解が決定される。
Figure 2019008767
式(10)は、1つのセグメントSGに対して選択されるダンプ候補位置DPの数が1つであり、1つのセグメントSGに対して複数のダンプ候補位置DPが選択されないことを意味する。例えば、図8に示すように、x2i(i = 1,2,...10)のうち、x23が“1”であるときには、x2iの他の値は全て“0”である。これは、2番目のセグメントSGから3番目のダンプ候補位置DPまでの走行パスが選択されるが、2番目のセグメントSGから他のダンプ候補位置DPまでのパスは選択されないことを意味している。すなわち、式(10)で示される第1の要求条件は、各セグメントSGの更なる区画を行わないことを意味する。
また、上記の式(10)は、n個のセグメントSGのそれぞれが必ずm個のダンプ候補位置DPのいずれか1つに運ばれることを意味する。ただし、1つのダンプ候補位置DPに対して複数のセグメントSGが選択されてもよい。
例えば、図8に示す例では、1番目と2番目のセグメントSGに対して3番目のダンプ候補位置DPが選択されている。3番目と4番目のセグメントSGに対して4番目のダンプ候補位置DPが選択されている。5〜8番目のセグメントSGに対して5番目のダンプ候補位置DPが選択されている。9番目と10番目のセグメントSGに対して6番目のダンプ候補位置DPが選択されている。このように最短距離モードでは、各セグメントSGが最も近いダンプ候補位置DPに分配される。
次に均等分配モードに付いて説明する。図9は、上述した制御モードのうち均等分配モードでのセグメントSGの分配の例を示している。均等分配モードでは、上述した式(1)の目的関数から、式(10)で示される第1の要求条件、及び、以下の式(11)で示される第2の要求条件に従うと共に移動距離の総和が最小となるように、セグメントSGとダンプ候補位置DPとの組み合わせの解が決定される。
Figure 2019008767
式(11)は、1つのダンプ候補位置DPに対して選択されるセグメントSGの数が1又は0であることを意味する。例えば、図9に示すように、xk1 (k = 1,2,...10)のうち、x11 が“1”であるときには、xk1の他の値は全て“0”となる。これは、1番目のセグメントSGから1番目のダンプ候補位置DPまでのパスが選択されると、1番目のダンプ候補位置DPには他のセグメントSGが選択されないことを意味している。
式(11)で示される第2の要求条件により、1のダンプ候補位置DPに対して１以下のセグメントSGが選択され、1のダンプ位置DPに対して2以上のセグメントSGは選択されない。従って、上記の式(11)で示す第2の要求条件は、各セグメントSGを各ダンプ候補位置DPに均等に分配するための要求条件を示している。
例えば、図9に示す例では、1番目〜10番目のセグメントSGに対して、1番目〜10番目のダンプ候補位置DPが、1対1で、それぞれ選択されている。このように最短距離モードでは、各セグメントSGが各ダンプ候補位置DPに均等に分配されるなかで最も近いダンプ候補位置DPにセグメントSGが分配される。
なお、均等分配モードでは、以下の式(12)で示すように、ダンプ候補位置DPの数mは、セグメントSGの数n以上であることが必要となる。
Figure 2019008767
図9に示す例では、ダンプ候補位置DPの数mとセグメントSGの数nとは共に10であるため、10のセグメントSGが10のダンプ候補位置DPに均等に分配される。ただし、ダンプ候補位置DPの数mが、セグメントSGの数nよりも多いときには、選択されないダンプ候補位置DPがあることになる。
次に目標分配モードに付いて説明する。図10は、上述した制御モードのうち目標分配モードでのセグメントSGの分配の例を示している。目標分配モードでは、上述した式(1)の目的関数から、式(10)で示される第1の要求条件、及び、以下の式(13)で示される第3の要求条件に従うと共に移動距離の総和が最小となるように、セグメントSGとダンプ候補位置DPとの組み合わせの解が決定される。
Figure 2019008767
yiは、i番目のダンプ候補位置DPに分配されるセグメントSGの数である。Vは、物体M1の総量である。
式(13)で示される第3の要求条件により、特定のダンプ候補位置DPに分配されるセグメントSGの個数が設定される。例えば、図10に示すように、
Figure 2019008767
である。これは1番目のダンプ候補位置DPに２つのセグメントSGを分配することを意味している。また、
Figure 2019008767
である。これは、2番目のダンプ候補位置DPには、セグメントSGを分配しないことを意味している。
例えば、図10に示す例では、1,3,4,5,10番目のダンプ候補位置DPに対して、それぞれ2つのセグメントSGを分配することが設定されている。それにより、図10に示すように、1番目のダンプ候補位置DPに対して1番目と2番目のセグメントSGが選択されている。3番目のダンプ候補位置DPに対して3番目と6番目のセグメントSGが選択されている。4番目のダンプ候補位置DPに対して4番目と7番目のセグメントSGが選択されている。5番目のダンプ候補位置DPに対して5番目と8番目のセグメントSGが選択されている。10番目のダンプ候補位置DPに対して9番目と10番目のセグメントSGが選択されている。ただし、2,6,7,8,9番目のダンプ候補位置DPにはセグメントSGが分配されない。
このように目標分配モードでは、特定ダンプ候補位置DPに分配されるセグメントSGの個数が決まっているなかで最も近いダンプ候補位置DPにセグメントSGが分配される。このように、式(13)で示される第3の要求条件により、特定のダンプ候補位置DPに、他の位置と異なる量の物体M1を分配することができる。それにより、例えば、他の場所と比べて土量の少ないダンプ候補位置DPを指定して、セグメントSGを運ぶことができる。
なお、yiはオペレータによって設定されてもよい。或いは、コントローラ31がダンピングエリアデータに基づいてyiを決定してもよい。
以上説明した、本実施形態に係る作業車両1の制御システム3によれば、ダンピングエリアの物体M1が複数のセグメントSGに分けられ、ダンピングエリアの崖の縁200に沿って複数のダンプ候補位置DPが決定される。そして、複数のセグメントSGと複数のダンプ候補位置DPとの組み合わせにより作業車両1の走行パスPHが決定される。従って、走行パスPHに沿って作業車両1を移動させることで、自動制御により、効率よくダンプ作業を行うことができる。
以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。
作業車両1は、ブルドーザに限らず、ホイールローダ等の他の車両であってもよい。作業車両1は、遠隔操縦可能な車両であってもよい。その場合、図11に示す作業車両1ａのように、運転室が省略されてもよい。なお、図11では、上述した実施形態に係る作業車両1に対応する構成に同一の符号を付している。
制御システム3の一部は、作業車両1の外部に配置されてもよい。例えば、コントローラ31は、互いに別体の複数のコントローラを有してもよい。図12に示すように、コントローラ31は、作業車両1の外部に配置されるリモートコントローラ311と、作業車両1に搭載される車載コントローラ312とを含んでもよい。リモートコントローラ311と車載コントローラ312とは通信装置33,36を介して無線により通信可能であってもよい。そして、上述したコントローラ31の機能の一部がリモートコントローラ311によって実行され、残りの機能が車載コントローラ312によって実行されてもよい。例えば、セグメントSGとダンプ候補位置DPとの組み合わせを決定する処理（S107）と走行パスPHを決定する処理（S108）とがリモートコントローラ311によって実行され、ダンプ作業を実行する処理（S109）が車載コントローラ312によって実行されてもよい。
作業車両1の自動制御は、オペレータによる手動操作と合わせて行われる半自動制御であってもよい。或いは、自動制御は、オペレータによる手動操作無しで行われる完全自動制御であってもよい。例えば、図12に示すように、作業車両1の外部に配置された操作装置37をオペレータが操作することによって作業車両1が操作されてもよい。その場合、操作装置37によって、作業車両1の前進、後進、及び旋回が操作されてもよい。或いは、操作装置37によって目標地点が設定され、コントローラ31による自動制御によって、作業車両1が目標地点まで走行してもよい。或いは、操作装置37による操作無しで、コントローラ31による自動制御のみによって作業車両1が走行してもよい。
ダンピングエリアデータとマテリアルデータとは、それぞれ別の装置で取得されてもよい。例えば、ダンピングエリアデータは、作業車両1の外部の測量装置から取得され、マテリアルデータは作業車両1に搭載された他の測量装置から取得されてもよい。
ダンプ作業は、オペレータの操作によって行われてもよい。例えば、図13に示すように、ステップＳ209において、走行パスPHが表示されてもよい。ここでは、図12に示すディスプレイ38に図8から図10に示すような走行パスPHの例が表示されてもよい。この場合、経験の少ないオペレータであっても、表示された走行パスPHに従って作業車両1を操作することで、効率よく且つ容易にダンプ作業を行うことができる。なお、図13において、ステップS201〜S208の処理は、図5におけるステップS101〜S108の処理とそれぞれ同じである。なお、操作装置37及びディスプレイ38は、作業車両1に搭載されてもよい。
コストが最小となるセグメントSGとダンプ候補位置DPとの組み合わせを決定する方法は、線形計画法に限らず、他の手法であってもよい。コストは、移動距離に限らず、作業時間、或いは、押し込みの回数など他のパラメータであってもよい。すなわち、移動距離に限らず、作業時間、或いは、押し込みの回数を最小化するように、セグメントSGとダンプ候補位置DPとの組み合わせが決定されてもよい。
上記の実施形態における要求条件の一部が省略又は変更されてもよい。或いは、上記の実施形態における要求条件と異なる要求条件が追加されてもよい。
複数のセグメントSGは、ブレードの最大容量に限らず、他の方法によって決定されてもよい。例えば、目標体積は、固定値であってもよい。或いは、目標体積は、作業車両1の状態に応じた可変値であってもよい。
走行パスPHは、セグメントSGとダンプ位置DPとを結ぶ直線に限らない。例えば、ブレードからの物体M1の漏れを最小化するように走行パスPHが決定されてもよい。
本発明によれば、作業車両によってダンプ作業を効率よく且つ容易に行うことができる。
31 コントローラ
200 ダンピングエリアの縁
M1 物体
SG セグメント
DP ダンプ位置
1 作業車両
3 制御システム
18 ブレード

Claims (20)

  1. ダンピングエリアの縁から物体を押し出すダンプ作業を行うための作業車両の制御システムであって、
    コントローラを備え、
    前記コントローラは、
    前記ダンピングエリアの縁の形状を示すダンピングエリアデータを取得し、
    前記ダンピングエリアの前記物体の形状を示すマテリアルデータを取得し、
    前記マテリアルデータに基づいて前記物体を区画した複数のセグメントを決定し、
    前記ダンピングエリアの縁に沿う複数のダンプ候補位置を決定し、
    前記複数のセグメントと前記複数のダンプ候補位置との組み合わせにより、前記ダンプ作業におけるダンプ位置を決定するように、プログラムされている、
    作業車両の制御システム。
  2. 前記コントローラは、前記組み合わせにより、前記ダンプ作業における前記作業車両の走行パスを決定するように、プログラムされている、
    請求項１に記載の作業車両の制御システム。
  3. 前記コントローラは、前記ダンプ作業のコストが最小となる前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせを決定するようにプログラムされている、
    請求項１又は２に記載の作業車両の制御システム。
  4. 前記コストは、前記作業車両の移動距離であり、
    前記コントローラは、前記作業車両の移動距離の総和が最小となる前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせを決定するようにプログラムされている、
    請求項３に記載の作業車両の制御システム。
  5. 前記コントローラは、線形計画法により前記コストが最小となる前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせを決定するようにプログラムされている、
    請求項３又は４に記載の作業車両の制御システム。
  6. 前記コントローラは、
    前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせにおいて所定の要求条件を設定し、
    前記要求条件を満たしつつ、前記コストが最小となる前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせを決定する、
    請求項３から５のいずれかに記載の作業車両の制御システム。
  7. 前記要求条件は、前記セグメントのそれぞれに対して選択される前記ダンプ候補位置の数が１つであることを含む、
    請求項６に記載の作業車両の制御システム。
  8. 前記要求条件は、前記ダンプ候補位置のそれぞれに対して選択される前記セグメントの数が１又は０であることを含む、
    請求項６又は７に記載の作業車両の制御システム。
  9. 前記要求条件は、特定の前記ダンプ候補位置に対して２以上の前記セグメントを選択することを含む、
    請求項６又は７に記載の作業車両の制御システム。
  10. 前記作業車両はブレードを備え、
    前記コントローラは、前記ブレードの最大容量に基づいて前記複数のセグメントを決定するようにプログラムされている、
    請求項１から９のいずれかに記載の作業車両の制御システム。
  11. 請求項１から１０のいずれかに記載の制御システムを備える作業車両。
  12. ダンピングエリアの縁から物体を押し出すダンプ作業を行うための作業車両の制御方法であって、
    前記ダンピングエリアの縁の形状を示すダンピングエリアデータを取得することと、
    前記ダンピングエリアの前記物体の形状を示すマテリアルデータを取得することと、
    前記マテリアルデータに基づいて前記物体を区画した複数のセグメントを決定することと、
    前記ダンピングエリアの縁に沿う複数のダンプ候補位置を決定することと、
    前記複数のセグメントと前記複数のダンプ候補位置との組み合わせを決定することと、
    前記組み合わせに従って前記ダンプ作業を行うように前記作業車両を制御することと、
    を備える作業車両の制御方法。
  13. 前記ダンプ作業のコストが最小となる前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせが決定される、
    請求項１２に記載の作業車両の制御方法。
  14. 前記コストは、前記作業車両の移動距離であり、
    前記作業車両の移動距離の総和が最小となる前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせが決定される、
    請求項１３に記載の作業車両の制御方法。
  15. 線形計画法により前記コストが最小となる前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせが決定される、
    請求項１３又は１４に記載の作業車両の制御方法。
  16. 前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせにおいて所定の要求条件を設定することをさらに備え、
    前記要求条件を満たしつつ、前記コストが最小となる前記複数のセグメントと前記複数のダンプ候補位置との前記組み合わせが決定される、
    請求項１３から１５のいずれかに記載の作業車両の制御方法。
  17. 前記要求条件は、前記セグメントのそれぞれに対して選択される前記ダンプ候補位置の数が１つであることを含む、
    請求項１６に記載の作業車両の制御方法。
  18. 前記要求条件は、前記ダンプ候補位置のそれぞれに対して選択される前記セグメントの数が１又は０であることを含む、
    請求項１６又は１７に記載の作業車両の制御方法。
  19. 前記要求条件は、特定の前記ダンプ位置に対して２以上の前記セグメントを選択することを含む、
    請求項１６又は１７に記載の作業車両の制御方法。
  20. 前記作業車両は、ブレードを備え、
    前記ブレードの最大容量に基づいて前記複数のセグメントが決定される、
    請求項１２から１９のいずれかに記載の作業車両の制御方法。
JP2019528324A 2017-07-07 2017-07-07 作業車両の制御システム、制御方法、及び作業車両 Active JP6861814B2 (ja)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2017/025022 WO2019008767A1 (ja) 2017-07-07 2017-07-07 作業車両の制御システム、制御方法、及び作業車両

Publications (2)

Publication Number Publication Date
JPWO2019008767A1 true JPWO2019008767A1 (ja) 2020-05-07
JP6861814B2 JP6861814B2 (ja) 2021-04-21

Family

ID=64950744

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019528324A Active JP6861814B2 (ja) 2017-07-07 2017-07-07 作業車両の制御システム、制御方法、及び作業車両

Country Status (5)

Country Link
US (1) US11035101B2 (ja)
JP (1) JP6861814B2 (ja)
AU (1) AU2017422760B2 (ja)
CA (1) CA3037945C (ja)
WO (1) WO2019008767A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7043300B2 (ja) * 2018-03-15 2022-03-29 株式会社小松製作所 作業機械の走行経路を計画するためのシステム、方法、及び作業機械

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0726586A (ja) * 1993-07-08 1995-01-27 Komatsu Ltd ブルドーザの自動ドージング制御装置
JPH07146707A (ja) * 1993-11-25 1995-06-06 Hazama Gumi Ltd 重機車両の遠隔操縦方法
JP2007164279A (ja) * 2005-12-09 2007-06-28 Komatsu Ltd 無人車両の誘導走行制御装置
US20090327011A1 (en) * 2008-06-30 2009-12-31 Autonomous Solutions, Inc. Vehicle dispatching method and system
JP2010211827A (ja) * 1998-02-13 2010-09-24 Komatsu Ltd 車両の誘導装置
JP2012118694A (ja) * 2010-11-30 2012-06-21 Komatsu Ltd 無人車両の走行システムにおける走行制御方法および無人車両の走行システム
JP2014526072A (ja) * 2011-06-03 2014-10-02 カーディナル オプティミゼーション， インコーポレイテッド 複数車両資源配分および経路指定解決策のためのシステムおよび方法
JP2016132912A (ja) * 2015-01-19 2016-07-25 鹿島建設株式会社 建設機械の施工方法及び建設機械の施工システム
US20160342915A1 (en) * 2015-05-22 2016-11-24 Caterpillar Inc. Autonomous Fleet Size Management

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3373121B2 (ja) * 1996-12-02 2003-02-04 株式会社小松製作所 ブルドーザのドージング装置
JPH11296229A (ja) * 1998-02-13 1999-10-29 Komatsu Ltd 車両の誘導装置
US9388550B2 (en) * 2014-09-12 2016-07-12 Caterpillar Inc. System and method for controlling the operation of a machine
US9297147B1 (en) * 2014-09-30 2016-03-29 Caterpillar Inc. Semi-autonomous tractor system crest ramp removal
US10724929B2 (en) * 2016-05-13 2020-07-28 Clarapath, Inc. Automated tissue sectioning and storage system
US10036137B2 (en) * 2016-07-15 2018-07-31 Caterpillar Inc. Autonomous loading system and method for operating same
WO2018136889A1 (en) * 2017-01-23 2018-07-26 Built Robotics Inc. Excavating earth from a dig site using an excavation vehicle

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0726586A (ja) * 1993-07-08 1995-01-27 Komatsu Ltd ブルドーザの自動ドージング制御装置
JPH07146707A (ja) * 1993-11-25 1995-06-06 Hazama Gumi Ltd 重機車両の遠隔操縦方法
JP2010211827A (ja) * 1998-02-13 2010-09-24 Komatsu Ltd 車両の誘導装置
JP2007164279A (ja) * 2005-12-09 2007-06-28 Komatsu Ltd 無人車両の誘導走行制御装置
US20090327011A1 (en) * 2008-06-30 2009-12-31 Autonomous Solutions, Inc. Vehicle dispatching method and system
JP2012118694A (ja) * 2010-11-30 2012-06-21 Komatsu Ltd 無人車両の走行システムにおける走行制御方法および無人車両の走行システム
JP2014526072A (ja) * 2011-06-03 2014-10-02 カーディナル オプティミゼーション， インコーポレイテッド 複数車両資源配分および経路指定解決策のためのシステムおよび方法
JP2016132912A (ja) * 2015-01-19 2016-07-25 鹿島建設株式会社 建設機械の施工方法及び建設機械の施工システム
US20160342915A1 (en) * 2015-05-22 2016-11-24 Caterpillar Inc. Autonomous Fleet Size Management

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
春名攻 他: "大規模整地工事計画のシステム化に関する研究", 土木学会論文報告集, vol. 第227号, JPN6020033709, 20 July 1974 (1974-07-20), pages 71 - 84, ISSN: 0004341830 *

Also Published As

Publication number Publication date
CA3037945A1 (en) 2019-01-10
US20200018047A1 (en) 2020-01-16
AU2017422760A1 (en) 2019-04-11
CA3037945C (en) 2021-01-12
AU2017422760B2 (en) 2019-11-14
JP6861814B2 (ja) 2021-04-21
US11035101B2 (en) 2021-06-15
WO2019008767A1 (ja) 2019-01-10

Similar Documents

Publication Publication Date Title
US11111653B2 (en) Control system for work vehicle, method for setting trajectory of work implement, and work vehicle
JP6934427B2 (ja) 作業車両の制御システム、及び作業機の軌跡設定方法
US10767341B2 (en) Control system for work vehicle, and method for setting trajectory of work implement
AU2018325613B2 (en) Control System for Work Vehicle, Method, and Work Vehicle
JP6910450B2 (ja) 作業車両の制御システム、方法、及び作業車両
CA3037530C (en) System and method for planning travel path for work machine, and work machine
WO2021131645A1 (ja) 作業機械を制御するためのシステムおよび方法
JP2019039280A (ja) 作業車両の制御システム、方法、及び作業車両
AU2020224468B2 (en) Control system and control method for work machine
US11414840B2 (en) Control system for work machine, method, and work machine
JP6861814B2 (ja) 作業車両の制御システム、制御方法、及び作業車両
JP7020895B2 (ja) 作業機械の制御システム、方法、及び作業機械
WO2019187792A1 (ja) 作業車両の制御システム、方法、及び作業車両

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200303

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200908

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201015

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210330

R150 Certificate of patent or registration of utility model

Ref document number: 6861814

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250