[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JP7204366B2 - 作業機械を制御するためのシステム及び方法 - Google Patents

作業機械を制御するためのシステム及び方法 Download PDF

Info

Publication number
JP7204366B2
JP7204366B2 JP2018144232A JP2018144232A JP7204366B2 JP 7204366 B2 JP7204366 B2 JP 7204366B2 JP 2018144232 A JP2018144232 A JP 2018144232A JP 2018144232 A JP2018144232 A JP 2018144232A JP 7204366 B2 JP7204366 B2 JP 7204366B2
Authority
JP
Japan
Prior art keywords
transport vehicle
controller
work machine
data
working machine
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2018144232A
Other languages
English (en)
Other versions
JP2020020155A (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
Priority to JP2018144232A priority Critical patent/JP7204366B2/ja
Priority to US16/980,709 priority patent/US11795658B2/en
Priority to DE112019000997.4T priority patent/DE112019000997T5/de
Priority to PCT/JP2019/010992 priority patent/WO2020026507A1/ja
Priority to CN201980015056.5A priority patent/CN111771031B/zh
Publication of JP2020020155A publication Critical patent/JP2020020155A/ja
Application granted granted Critical
Publication of JP7204366B2 publication Critical patent/JP7204366B2/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
    • E02F9/2041Automatic repositioning of implements, i.e. memorising determined positions of the implement
    • 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/439Automatic repositioning of the implement, e.g. automatic dumping, auto-return
    • 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/08Superstructures; Supports for superstructures
    • E02F9/10Supports for movable superstructures mounted on travelling or walking gears or on other superstructures
    • E02F9/12Slewing or traversing gears
    • E02F9/121Turntables, i.e. structure rotatable about 360°
    • E02F9/123Drives or control devices specially adapted 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/24Safety devices, e.g. for preventing overload
    • 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
    • E02F9/262Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60PVEHICLES ADAPTED FOR LOAD TRANSPORTATION OR TO TRANSPORT, TO CARRY, OR TO COMPRISE SPECIAL LOADS OR OBJECTS
    • B60P1/00Vehicles predominantly for transporting loads and modified to facilitate loading, consolidating the load, or unloading
    • B60P1/04Vehicles predominantly for transporting loads and modified to facilitate loading, consolidating the load, or unloading with a tipping movement of load-transporting element
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60PVEHICLES ADAPTED FOR LOAD TRANSPORTATION OR TO TRANSPORT, TO CARRY, OR TO COMPRISE SPECIAL LOADS OR OBJECTS
    • B60P1/00Vehicles predominantly for transporting loads and modified to facilitate loading, consolidating the load, or unloading
    • B60P1/04Vehicles predominantly for transporting loads and modified to facilitate loading, consolidating the load, or unloading with a tipping movement of load-transporting element
    • B60P1/16Vehicles predominantly for transporting loads and modified to facilitate loading, consolidating the load, or unloading with a tipping movement of load-transporting element actuated by fluid-operated mechanisms
    • B60P1/162Vehicles predominantly for transporting loads and modified to facilitate loading, consolidating the load, or unloading with a tipping movement of load-transporting element actuated by fluid-operated mechanisms the hydraulic system itself
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2221Control of flow rate; Load sensing arrangements
    • E02F9/2232Control of flow rate; Load sensing arrangements using one or more variable displacement pumps
    • E02F9/2235Control of flow rate; Load sensing arrangements using one or more variable displacement pumps including an electronic controller
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2296Systems with a variable displacement pump

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)
  • Component Parts Of Construction Machinery (AREA)

Description

本発明は、作業機械を制御するためのシステム及び方法に関する。
油圧ショベルなどの作業機械によって土砂などの素材を掘削して、ダンプトラックなどの運搬車両に積み込む作業がある。運搬車両は、所定の積込位置で材料を積み込まれる。運搬車両は、所定のダンプ位置まで走行して、ダンプ位置で素材をダンプする。そして、運搬車両は積込位置へ戻り、作業機械によって再び素材が積み込まれる。
従来、上記のような作業機械による積込作業を自動制御によって行う技術が知られている。例えば、特許文献1では、掘削位置と排土位置とが作業機械のコントローラに予め教示される。コントローラは、掘削位置で掘削を行い、掘削位置から排土位置に向けて作業機械を旋回させ、排土位置で排土するように作業機械を制御する。
特開2000-192514号公報
上記の技術によれば、自動制御によって作業機械による積込作業を行うことができる。しかし、積込作業は、作業機械だけではなく運搬車両と協働して行われる。従って、積込作業をより効率よく行うためには、作業機械と運搬車両とが適切に連携して作業を行うことが重要である。
本発明の目的は、作業機械による積込作業を自動制御によって行うと共に、作業機械と運搬車両との連携を適切に行うことにある。
第1の態様は、運搬車両に素材を積み込む作業機械を制御するためのシステムである。システムは、検出装置とコントローラとを備える。検出装置は、運搬車両の動作を検出する。コントローラは、作業機械を制御する。コントローラは、運搬車両の動作を示す動作データを検出装置から取得する。コントローラは、動作データに基づいて、所定の積込位置での運搬車両の停止を判定する。コントローラは、運搬車両が積込位置で停止していると判定したときに、作業機械を制御して排土させる。
第2の態様は、運搬車両に素材を積み込む作業機械を制御するためにコントローラによって実行される方法である。当該方法は、以下の処理を備える。第1の処理は、運搬車両の動作を示す動作データを取得することである。第2の処理は、動作データに基づいて、所定の積込位置での運搬車両の停止を判定することである。第3の処理は、運搬車両が積込位置で停止していると判定したときに、作業機械を制御して排土させることである。
本発明によれば、運搬車両の動作が検出され、運搬車両が積込位置で停止しているときに、作業機械に排土を行わせることができる。そのため、作業機械と運搬車両とが適切に連携して作業を行うことができる。それにより、作業機械による積込作業を自動制御によって行うと共に、作業効率を向上させることができる。
作業機械が用いられる作業現場の一例を示す平面図である。 作業機械の側面図である。 作業機械の構成を示すブロック図である。 運搬車両の側面図である。 運搬車両の構成を示すブロック図である。 待機モードでの処理を示すフローチャートである。 積込モードでの処理を示すフローチャートである。 積込モードでの処理を示すフローチャートである。 積込モードでの処理を示すフローチャートである。 自動制御モードにおける作業現場の状況を模式的に示す平面図である。 自動制御モードにおける作業現場の状況を模式的に示す平面図である。 自動制御モードにおける作業現場の状況を模式的に示す平面図である。 自動制御モードにおける作業現場の状況を模式的に示す平面図である。 自動制御モードにおける作業現場の状況を模式的に示す平面図である。 自動制御モードにおける作業現場の状況を模式的に示す平面図である。 自動制御モードにおける作業現場の状況を模式的に示す平面図である。 自動制御モードにおける作業現場の状況を模式的に示す平面図である。 自動制御モードにおける作業現場の状況を模式的に示す平面図である。 第1カメラ或いは第2カメラによって撮影された画像の一例を示す図である。 第1カメラによって撮影された画像の一例を示す図である。 現在の位置で作業機械が掘削可能な素材の範囲を示す図である。 現在の地形の断面と掘削経路との一例を示す図である。 第1カメラによって撮影された画像の一例を示す図である。
以下、実施形態に係る作業機械1の制御システムについて、図面を参照しながら説明する。図1は、作業機械1が用いられる作業現場の一例を示す平面図である。作業現場には、作業機械1と運搬車両2とが配置されている。作業機械1は、自動制御により運搬車両2と協働して作業を行う。
本実施形態において、作業機械1は油圧ショベルである。運搬車両2はダンプトラックである。作業機械1は、作業現場内の所定の掘削位置L1の横に配置されている。運搬車両2は、作業現場内の所定の積込位置L2と所定のダンプ位置L3との間を走行して往復する。作業機械1は、自動制御により、掘削位置L1を掘削して、掘削対象物としての土砂等の素材を、積込位置L2に停車している運搬車両2に積み込む。素材を積み込まれた運搬車両2は、ダンプ位置L3まで走行し、ダンプ位置L3に素材を降ろす。ダンプ位置L3には、ブルドーザなどの他の作業機械3が配置されており、ダンプ位置L3に降ろされた素材を敷き広げる。素材を降ろした運搬車両2は積込位置L2まで走行し、作業機械1は、積込位置L2に停車した運搬車両2に再び素材を積み込む。このような作業が繰り返されることで、掘削位置L1の素材がダンプ位置L3に移送される。
図2は、作業機械1の側面図である。図2に示すように、作業機械1は、車両本体11と作業機12とを含む。車両本体11は、旋回体13と走行体14とを含む。旋回体13は、走行体14に対して旋回可能に取り付けられている。旋回体13にはキャブ15が配置されている。ただし、キャブ15は省略されてもよい。走行体14は、履帯16を含む。後述するエンジン24の駆動力によって履帯16が駆動されることで、作業機械1は走行する。
作業機12は、車両本体11の前部に取り付けられている。作業機12は、ブーム17とアーム18とバケット19とを含む。ブーム17は、旋回体13に対して上下方向に動作可能に取り付けられている。アーム18は、ブーム17に対して動作可能に取り付けられている。バケット19は、アーム18に対して動作可能に取り付けられている。作業機12は、ブームシリンダ21と、アームシリンダ22と、バケットシリンダ23とを含む。ブームシリンダ21と、アームシリンダ22と、バケットシリンダ23とは、油圧シリンダであり、後述する油圧ポンプ25からの作動油によって駆動される。ブームシリンダ21は、ブーム17を動作させる。アームシリンダ22は、アーム18を動作させる。バケットシリンダ23は、バケット19を動作させる。
図3は、作業機械1の制御システムの構成を示すブロック図である。図3に示すように、作業機械1は、エンジン24と、油圧ポンプ25と、動力伝達装置26と、コントローラ27とを含む。
エンジン24は、コントローラ27からの指令信号により制御される。油圧ポンプ25は、エンジン24によって駆動され、作動油を吐出する。油圧ポンプ25から吐出された作動油は、ブームシリンダ21と、アームシリンダ22と、バケットシリンダ23とに供給される。
作業機械1は、旋回モータ28を含む。旋回モータ28は、油圧モータであり、油圧ポンプ25からの作動油によって駆動される。旋回モータ28は、旋回体13を旋回させる。なお、図2では、1つの油圧ポンプ25が図示されているが、複数の油圧ポンプが設けられてもよい。
油圧ポンプ25にはポンプ制御装置29が接続されている。油圧ポンプ25は可変容量ポンプである。ポンプ制御装置29は、油圧ポンプ25の傾転角を制御する。ポンプ制御装置29は、例えば電磁弁を含み、コントローラ27からの指令信号により制御される。コントローラ27は、ポンプ制御装置29を制御することで、油圧ポンプ25の容量を制御する。
油圧ポンプ25とシリンダ21-23と旋回モータ28とは、制御弁31を介して油圧回路によって接続されている。制御弁31は、コントローラ27からの指令信号によって制御される。制御弁31は、油圧ポンプ25からシリンダ21-23及び旋回モータ28に供給される作動油の流量を制御する。コントローラ27は、制御弁31を制御することで、作業機12の動作を制御する。また、コントローラ27は、制御弁31を制御することで、旋回体13の旋回を制御する。
動力伝達装置26は、エンジン24の駆動力を走行体14に伝達する。動力伝達装置26は、例えば、トルクコンバーター、或いは複数の変速ギアを有するトランスミッションであってもよい。或いは、動力伝達装置26は、HST(Hydro Static Transmission)、或いはHMT(Hydraulic Mechanical Transmission)などの他の形式のトランスミッションであってもよい。
コントローラ27は、取得したデータに基づいて作業機械1を制御するようにプログラムされている。コントローラ27は、エンジン24と走行体14と動力伝達装置26とを制御することで、作業機械1を走行させる。コントローラ27は、エンジン24と油圧ポンプ25と制御弁31とを制御することで、作業機12を動作させる。
コントローラ27はCPU或いはGPU等のプロセッサ271と、記憶装置272とを含む。プロセッサ271は、作業機械1の自動制御のための処理を行う。記憶装置272は、RAM或いはROMなどのメモリ、及び、HDD(Hard Disk Drive)或いはSSD(Solid State Drive)などの補助記憶装置を含む。記憶装置272は、作業機械1の自動制御のためのデータ及びプログラムを記憶している。
作業機械1は、負荷センサ32a-32cを含む。負荷センサ32a-32cは、作業機12にかかる負荷を検出し、負荷を示す負荷データを出力する。本実施形態では、負荷センサ32a-32cは、油圧センサであり、シリンダ21-23の油圧をそれぞれ検出する。負荷データは、シリンダ21-23の油圧を示す。コントローラ27は、負荷センサ32a-32cと有線或いは無線によって通信可能に接続されている。コントローラ27は、負荷センサ32a-32cから負荷データを受信する。
作業機械1は、位置センサ33と、作業機センサ34a-34cと、旋回角度センサ39とを含む。位置センサ33は、作業機械1の位置を検出し、作業機械1の位置を示す位置データを出力する。位置センサ33は、GNSS(Global Navigation Satellite System)レシーバとIMU(慣性計測装置:Inertial Measurement Unit)とを含む。GNSSレシーバは、例えばGPS(Global Positioning System)用の受信機である。位置データは、GNSSレシーバが出力する作業機械1の位置を示すデータと、IMUが出力する車両本体11の姿勢を示すデータとを含む。車両本体11の姿勢は、例えば、作業機械1の前後方向の水平に対する角度(ピッチ角)と、作業機械1の横方向の水平に対する角度(ロール角)とを含む。
作業機センサ34a-34cは、作業機12の姿勢を検出し、作業機12の姿勢を示す姿勢データを出力する。作業機センサ34a-34cは、例えばシリンダ21-23のストローク量を検出するストロークセンサである。作業機12の姿勢データは、シリンダ21-23のストローク量を含む。或いは、作業機センサ34a-34cは、ブーム17、アーム18、及びバケット19のそれぞれの回転角度を検出するセンサなどの他のセンサであってもよい。旋回角度センサ39は、走行体14に対する旋回体13の旋回角度を検出し、旋回角度を示す旋回角度データを出力する。
コントローラ27は、位置センサ33、作業機センサ34a-34c、及び旋回角度センサ39と有線或いは無線によって通信可能に接続されている。コントローラ27は、位置センサ33と作業機センサ34a-34cと旋回角度センサ39とから、それぞれ作業機械1の位置データと作業機12の姿勢データと旋回角度データとを受信する。コントローラ27は、位置データと姿勢データと旋回角度データとから、バケット19の刃先位置を算出する。例えば、作業機械1の位置データは、位置センサ33のグローバル座標を示す。コントローラ27は、作業機12の姿勢データと旋回角度データとに基づいて、位置センサ33のグローバル座標からバケット19の刃先位置のグローバル座標を算出する。
作業機械1は、地形センサ35を含む。地形センサ35は、作業機械1の周囲の地形を計測して、地形センサ35が計測した地形を示す地形データを出力する。本実施形態では、地形センサ35は、旋回体13の側部に取り付けられている。地形センサ35は、旋回体13の側方に位置する地形を計測する。地形センサ35は、例えばライダ(LIDAR:Laser Imaging Detection and Ranging)である。ライダは、レーザーを照射して、その反射光を計測することで、地形上の複数の計測点までの距離を測定する。地形データは、作業機械1に対する各計測点の位置を示す。
作業機械1は、第1カメラ36と、複数の第2カメラ37とを含む。第1カメラ36は、旋回体13の前方に向けて、旋回体13に取り付けられている。第1カメラ36は、旋回体13の前方を撮影する。第1カメラ36はステレオカメラである。第1カメラ36は、撮影した動画を示す第1画像データを出力する。
複数の第2カメラ37は、それぞれ旋回体13の左側方と右側方と後方とに向けて、旋回体13に取り付けられている。第2カメラ37は、撮影した動画を示す第2画像データを出力する。第2カメラ37は、単眼カメラであってもよい。或いは、第2カメラ37は、第1カメラ36と同様にステレオカメラであってもよい。コントローラ27は、第1カメラ36及び第2カメラ37と有線或いは無線により通信可能に接続されている。コントローラ27は、第1カメラ36から第1画像データを受信する。コントローラ27は、第2カメラ37から第2画像データを受信する。
作業機械1は、通信装置38を含む。通信装置38は、作業機械1の外部の機器とデータ通信を行う。通信装置38は、作業機械1の外部のリモートコンピュータ機器4と通信を行う。リモートコンピュータ機器4は、作業現場に配置されてもよい。或いは、リモートコンピュータ機器4は、作業現場から離れた管理センタ内に配置されてもよい。リモートコンピュータ機器4は、ディスプレイ401と入力装置402とを含む。
ディスプレイ401は、作業機械1に関する画像を表示する。ディスプレイ401は、コントローラ27から通信装置38を介して受信した信号に応じた画像を表示する。入力装置402は、オペレータによって操作される。入力装置402は、例えばタッチパネルを含んでもよく、或いは、ハードウェアキーを含んでもよい。リモートコンピュータ機器4は、入力装置402によって入力された指令を示す信号を、通信装置38を介してコントローラ27に送信する。また、通信装置38は、運搬車両2とデータ通信を行う。
図4は、運搬車両2の側面図である。図4に示すように、運搬車両2は、車両本体51と、走行体52と、荷台53とを含む。車両本体51は、走行体52に支持されている。走行体52は、履帯54を含む。後述するエンジン55の駆動力によって履帯54が駆動されることで、運搬車両2は走行する。荷台53は、車両本体51に支持されている。荷台53は、ダンプ姿勢と運搬姿勢とに動作可能に設けられている。図4において、実線で示す荷台53は、運搬姿勢の荷台53の位置を示している。二点鎖線で示す荷台53’は、ダンプ姿勢の荷台53の位置を示している。運搬姿勢では、荷台53は、概ね水平に配置される。ダンプ姿勢では、荷台53は、運搬姿勢に対して傾斜した状態となる。
図5は、運搬車両2の制御システムの構成を示すブロック図である。運搬車両2は、エンジン55と、油圧ポンプ56と、動力伝達装置57と、リフトシリンダ58と、旋回モータ59と、コントローラ61と、制御弁62とを含む。コントローラ61は、プロセッサ611と、揮発性記憶部612と、不揮発性記憶部613とを含む。
エンジン55、油圧ポンプ56、動力伝達装置57、コントローラ61、制御弁62は、それぞれ作業機械1のエンジン24、油圧ポンプ25、動力伝達装置26、コントローラ27、制御弁31と同様の構成であるため、詳細な説明を省略する。
リフトシリンダ58は、油圧シリンダである。旋回モータ59は、油圧モータである。油圧ポンプ56から吐出された作動油は、リフトシリンダ58と旋回モータ59とに供給される。リフトシリンダ58と旋回モータ59とは、油圧ポンプ56からの作動油によって駆動される。リフトシリンダ58は、荷台53を昇降する。それにより、荷台53の姿勢が、運搬姿勢とダンプ姿勢とに切り換えられる。旋回モータ59は、走行体52に対して車両本体51を旋回させる。コントローラ61は、制御弁62によってリフトシリンダ58を制御することで、荷台53の動作を制御する。また、コントローラ61は、制御弁62によって旋回モータ59を制御することで、車両本体51の旋回を制御する。
運搬車両2は、位置センサ63と、荷台センサ64と、旋回角度センサ65とを含む。位置センサ63は、作業機械1の位置センサ33と同様に、位置データを出力する。位置データは、運搬車両2の位置を示すデータと、車両本体51の姿勢を示すデータとを含む。
荷台センサ64は、荷台53の姿勢を検出し、荷台53の姿勢を示す荷台データを出力する。荷台センサ64は、例えばリフトシリンダ58のストローク量を検出するストロークセンサである。荷台データは、リフトシリンダ58のストローク量を含む。或いは、荷台センサ64は、荷台53の傾斜角度を検出するセンサなどの他のセンサであってもよい。旋回角度センサ65は、走行体52に対する車両本体51の旋回角度を検出し、旋回角度を示す旋回角度データを出力する。
コントローラ61は、位置センサ63と、荷台センサ64と、旋回角度センサ65と、有線或いは無線によって通信可能に接続されている。コントローラ61は、位置センサ63と荷台センサ64と旋回角度センサ65から、それぞれ位置データと荷台データと旋回角度データとを受信する。
運搬車両2は、通信装置66を含む。運搬車両2のコントローラ61は、通信装置66を介して、作業機械1のコントローラ27とデータ通信を行う。運搬車両2のコントローラ61は、通信装置66を介して、運搬車両2の位置データと荷台データと旋回角度データとを送信する。作業機械1のコントローラ27は、通信装置38を介して、運搬車両2の位置データと荷台データと旋回角度データとを受信する。作業機械1のコントローラ27は、運搬車両2の車両本体51、及び、荷台53の配置及び寸法を示す車両寸法データを記憶している。コントローラ27は、運搬車両2の位置データと荷台データと旋回角度データと車両寸法データとから、荷台53の位置を算出する。
次に、作業機械1のコントローラ27によって実行される自動制御モードの処理について説明する。自動制御モードでは、コントローラ27は、上述した掘削及び積込の作業を自動で行うように、作業機械1を制御する。図6から図9は、自動制御モードの処理を示すフローチャートである。
自動制御モードは、積込モードと、積込モード以外の他の制御モードとを含む。本実施形態において他のモードは、待機モードである。待機モードでは、コントローラ27は、運搬車両2が積込位置L2に到着して停車するまで、作業機械1を待機させる。なお、他のモードは、待機モード以外に、崩れた素材を集めておくモード、他の領域を掘削して素材を新たに増やす掘削モードなどのモードを含んでもよい。
積込モードでは、コントローラ27は、運搬車両2が積込位置L2で停車しているときに、運搬車両2への積込作業を行うように作業機械1を動作させる。図6は、待機モードでの処理を示すフローチャートである。図7から図9は、積込モードでの処理を示すフローチャートである。図10から図18は、自動制御モードにおける作業現場の状況を模式的に示す平面図である。
コントローラ27は、自動制御モードの開始指令を受信すると、作業機械1のエンジン24を始動すると共に、図6に示す待機モードの処理を実行する。図10に示すように、自動制御モードの開始指令は、例えばオペレータが上述したリモートコンピュータ機器4の入力装置402を操作することで、リモートコンピュータ機器4から出力される。コントローラ27は、通信装置38を介して開始指令を受信する。また、運搬車両2も、自動制御モードの開始指令を受信する。運搬車両2は、自動制御モードの開始指令を受信すると、積込位置L2に向かって移動を開始する。
図6に示すように、ステップS101では、コントローラ27は、作業機械1を排土待姿勢で待機させる。すなわち、待機モードでは、コントローラ27は、排土待姿勢で、作業機12と旋回体13と走行体14とを停止状態に維持する。図10に示すように、排土待姿勢では、作業機12が積込位置L2を向くように配置される。すなわち、排土待姿勢では、旋回体13の前方が積込位置L2を向いている。また、排土待姿勢では、バケット19が、運搬車両2の荷台53の高さよりも上方の位置に配置される。
ステップS102では、コントローラ27は、作業機械1の位置を取得する。ここでは、コントローラ27は、位置センサ33と、作業機センサ34a-34cと、旋回角度センサ39とから、それぞれ作業機械1の位置データと作業機12の姿勢データと旋回角度データとを取得する。コントローラ27は、位置データと作業機データと旋回角度データとから、バケット19の刃先位置を算出する。
ステップS103では、コントローラ27は、画像データを取得する。ここでは、コントローラ27は、旋回体13の前方の動画を示す第1画像データを第1カメラ36から取得する。コントローラ27は、旋回体13の両側方及び後方の動画を示す第2画像データを第2カメラ37から取得する。なお、第1カメラ36と第2カメラ37とは、少なくとも自動制御モードの実行中には、常時、撮影を行って、第1画像データと第2画像データとを生成する。コントローラ27は、少なくとも自動制御モードの実行中には、第1カメラ36と第2カメラ37とから、リアルタイムに第1画像データと第2画像データとを取得する。
ステップS104では、コントローラ27は、画像処理1を実行する。画像処理1は、第1画像データと第2画像データとに基づいて、画像認識技術により、作業機械1の周囲における人の存在を検出する。従って、第1カメラ36と第2カメラ37とは、作業機械1の周囲の領域における人の存在を検出する人検出装置に相当する。
コントローラ27は、例えばAI(Artificial Intelligence)を用いた画像認識技術により、第1画像データと第2画像データとが示す画像中の人の存在を検出する。図19は、第1カメラ36或いは第2カメラ37によって撮影された画像の一例を示す図である。図19に示すように、第1画像データ又は第2画像データが示す画像に人が含まれるときには、コントローラ27は、画像中の人を認識して検出する。ステップS105では、コントローラ27は、作業機械1の周囲における人の存在が検出されたかを判定する。人の存在が検出されないときには、処理はステップS106に進む。
ステップS106では、コントローラ27は、画像処理2を実行する。画像処理2では、コントローラ27は、第1画像データに基づいて、画像認識技術により、運搬車両2の存在を検出する。従って、第1カメラ36は、作業機械1への運搬車両2の接近を検出する車両検出装置に相当する。画像認識技術については、ステップS104と同様である。図11に示すように、第1カメラ36の撮影範囲内に運搬車両2が到達したときに、コントローラ27は、運搬車両2の存在を検出する。
図20は、第1カメラの撮影範囲内に運搬車両2が到達したときに、第1カメラ36によって撮影された画像の一例を示す図である。図20に示すように、第1画像データが示す画像に運搬車両2が含まれるときには、コントローラ27は、画像中の運搬車両2を認識して検出する。
ステップS107では、コントローラ27は、運搬車両2と通信を行う。ここでは、コントローラ27は、通信装置38を介して、運搬車両2から、運搬車両2の位置データを受信する。また、コントローラ27は、通信装置38を介して、運搬車両2から荷台データと旋回角度データとを受信する。
ステップS108では、コントローラ27は、運搬車両2の接近が検出されたかを判定する。コントローラ27は、作業機械1から運搬車両2までの距離が所定の閾値以下であるときに、運搬車両2の接近が検出されたと判定する。コントローラ27は、第1画像データを解析することで、作業機械1から運搬車両2までの距離を算出する。或いは、コントローラ27は、作業機械1の位置データと運搬車両2の位置データとから、作業機械1から運搬車両2までの距離を算出してもよい。運搬車両2の接近が検出されたときには、処理は図7に示すステップS201に進む。すなわち、コントローラ27は、自動制御モードを待機モードから積込モードに遷移させる。
ステップS105において人を検出していないこと、及び、ステップS108において運搬車両2の接近を検出したことは、自動制御モードを待機モードから積込モードに遷移させるための遷移条件である。コントローラ27は、遷移条件が満たされているときに、自動制御モードを待機モードから積込モードに遷移させる。コントローラ27は、遷移条件が満たされていないときには、自動制御モードを待機モードから積込モードに遷移させずに、待機モードに維持する。なお、遷移条件は、他の条件をさらに含んでもよい。
ステップS108において、コントローラ27が運搬車両2の接近を検出しなかったときには、処理はステップS109に進む。ステップS109では、コントローラ27は、終了信号を受信したかを判定する。終了信号は、リモートコンピュータ機器4から送信される。終了信号は、オペレータが入力装置402を操作することで、リモートコンピュータ機器4からコントローラ27に送信される。終了信号を受信すると、コントローラ27は、自動制御モードを終了する。自動制御モードが終了すると、コントローラ27は、作業機械1のエンジン24を停止させる。また、運搬車両2のコントローラ61は、終了信号を受信すると、運搬車両2を停止させる。
図12に示すように、作業機械1の周囲に人100が侵入すると、ステップS105において、コントローラ27が人100の存在を検出する。コントローラ27が人100の存在を検出したときには、処理はステップS110に進む。ステップS110では、コントローラ27は、出力装置に警報を出力させるように警報信号を出力する。本実施形態では、出力装置は、リモートコンピュータ機器4である。リモートコンピュータ機器4は、警報信号を受信すると、警報を示すメッセージ、或いは、画像をディスプレイ401に表示する。リモートコンピュータ機器4は、警報信号を受信すると、警報を示す音声を出力してもよい。
なお、出力装置は、リモートコンピュータ機器4に限らず他の装置であってもよい。例えば、出力装置は、作業機械1に取り付けられた、或いは作業機械の1の外部に配置された警告灯、或いはスピーカーであってもよい。コントローラ27は、人の存在を検出したときには、警告灯を点灯、或いは、スピーカーから警告音を発するように、指令信号を出力してもよい。
コントローラ27は、ステップS110において出力装置に警報を出力させた後、ステップS109において、終了信号を受信したかを判定する。終了信号を受信したときには、コントローラ27は、自動制御モードを停止させる。終了信号を受信しないときには、コントローラ27は、自動制御モードを待機モードに維持する。
待機モードにおいて、作業機械1の周囲に人の存在を検出したときには、コントローラ27は、運搬車両2の接近を検出しても、自動制御モードを積込モードに遷移させずに、待機モードに維持する。なお、後述する積込モード中に、人の存在を検出したときには、コントローラ27は、作業機12及び旋回体13の動作を停止させる。また、コントローラ27は、人の存在を検出したときには、待機モードと積込モードとのいずれにおいても、運搬車両2を停止させる指令信号を運搬車両2のコントローラ61に送信してもよい。
次に、積込モードでの処理について説明する。コントローラ27は、積込モードにおいて、所定の掘削位置L1で作業機12による掘削を行い、掘削位置L1から積込位置L2に向けて旋回体13と旋回させ、積込位置L2で作業機12から排土することで、積込作業を行う。図7に示すように、積込モードでは、ステップS201において、コントローラ27は、地形を計測する。ここでは、図13に示すように、地形センサ35が、作業機械1の側方に位置する掘削位置L1の地形を計測する。コントローラ27は、地形センサ35が計測した掘削位置L1の地形を示す地形データを取得する。なお、コントローラ27は、旋回体13が停止しているのか、或いは動作しているのかを判定し、旋回体13が停止していると判定したときに、地形センサ35による地形の計測を行ってもよい。
ステップS202では、コントローラ27は、掘削量を確保可能かを判定する。ここでは、コントローラ27は、現在の作業機械1の位置で作業機12及び旋回体13を動作させたときに、所定量以上の素材を掘削により取得できるかを判定する。例えば、図21に示すように、コントローラ27は、現在の作業機械1の位置で作業機12及び旋回体13を動作させたときの作業機12の軌跡と、地形データが示す掘削位置L1の地形とから、現在の位置で掘削可能な素材の量を算出する。図21においては、作業機12を動作させたときに掘削可能な範囲にハッチングが付されている。そして、コントローラ27は、掘削可能な素材の量が所定値以上であるときに、掘削量を確保可能と判定する。コントローラ27が掘削量を確保不可能と判定したときには、処理はステップS203に進む。
ステップS203では、コントローラ27は、作業機械1の位置を調整する。例えば、コントローラ27は、作業機械1を所定距離、前後に移動させる。そして、ステップS201において、コントローラ27は再び地形を計測し、ステップS202において、掘削量を確保可能かを判定する。
ステップS202において、コントローラ27が掘削量を確保可能と判定したときには、処理はステップS204に進む。ステップS204では、コントローラ27は、積込可能重量を計算する。コントローラ27は、運搬車両2に積み込み可能な最大積載重量を記憶している。コントローラ27は、最大積載重量と既に運搬車両2に積み込まれた素材の重量とから、積込可能重量を算出する。
ステップS205では、コントローラ27は、積込計画を立てる。ここでは、コントローラ27は、作業機械1の現在位置と地形データと目標体積とから、掘削経路PA1(図22)と目標旋回角度TA1(図14)とを決定する。掘削経路PA1は、作業機12の刃先の目標軌跡である。コントローラ27は、作業機械1の現在位置と地形データとから、作業機12によって掘削される素材の量が目標体積と一致するように、掘削経路PA1を決定する。
後述のように、コントローラ27は、掘削によって抱え込まれたバケット19内の素材の重量を算出可能である。コントローラ27は、運搬車両2への排土ごとにバケット19内の素材の重量を積算することで、運搬車両2への積み込み量を把握することができる。なお、初回掘削時は、運搬車両2への積み込み量はゼロとなる。
図22は、現在の地形T1の断面と掘削経路PA1との一例を示す図である。図22に示すように、コントローラ27は、現在の地形T1の表面と掘削経路PA1との間の体積(図22においてハッチングを付した部分)が目標体積に一致するように、掘削経路PA1を決定する。掘削経路PA1は、掘削開始点S1と掘削終了点E1とを含む。掘削開始点S1と掘削終了点E1とは、地形T1の表面と掘削経路PA1との交点である。例えば、掘削開始点S1は、作業機械1に対して掘削終了点E1よりも遠くに位置する。コントローラ27は、掘削開始点S1の位置を算出し、掘削開始点S1から目標旋回角度TA1を決定する。
コントローラ27は、積込可能重量に応じて目標体積を決定する。コントローラ27は、後述するように素材の比重を算出し、比重に基づいて積込可能重量を体積に換算する。コントローラ27は、積込可能重量から積み込み可能容量を算出し、積込可能容量に基づいてから目標体積を算出する。
詳細には、積込可能容量が、バケット19の掘削容量以上であるときには、コントローラ27は、バケット19の掘削容量を目標体積として決定する。バケット19の掘削容量は、記憶装置272に記憶されている。積込可能容量が、バケット19の掘削容量より小さいときには、コントローラ27は、積込可能容量を目標体積として決定する。なお、1回目の掘削の実行時には、比重、或いは目標体積は所定の初期値であってもよい。
ステップS206では、コントローラ27は、自動ダウン旋回を実行する。ここでは、図14に示すように、コントローラ27は、排土待姿勢の位置から掘削開始点S1に向かって、目標旋回角度TA1分、旋回体13を旋回させると共に、作業機12の刃先を排土待姿勢での高さから掘削開始点S1の高さに向かって下降させる。
ステップS207では、コントローラ27は、自動掘削を実行する。ここでは、コントローラ27は、掘削計画において決定した掘削経路PA1に従って作業機12の刃先が移動するように、作業機12を制御する。
ステップS208では、コントローラ27は、作業機械1の位置データを補正する。ここでは、コントローラ27は、位置センサ33と作業機センサ34a-34cと旋回角度センサ39とから作業機械1の位置データと作業機12の姿勢データと旋回角度データとを再度取得して、ステップS102で取得した作業機械1の位置を補正する。
ステップS209では、コントローラ27は、排土計画を立てる。ここでは、コントローラ27は、現在の作業機械1の位置と運搬車両2の荷台位置とから、目標旋回角度TA2と排土位置P1とを決定する。排土位置P1は、排土待姿勢でのバケット19の刃先の位置を示す。運搬車両2の荷台位置は、運搬車両2が積込位置L2に位置している状態での荷台53の位置を示す。コントローラ27は、予め決定された荷台位置を記憶していてもよい。或いは、コントローラ27は、積込位置L2と運搬車両2の車両寸法データとから、荷台位置を算出してもよい。コントローラ27は、荷台53に向かって作業機12が正対し、且つ、刃先が荷台53よりも所定距離上方に位置するように、排土位置P1を決定する。
ステップS210では、コントローラ27は、自動ホイスト旋回を実行する。ここでは、図15に示すように、コントローラ27は、排土位置P1に向けて、目標旋回角度TA2分、旋回体13を旋回させると共に、作業機12の刃先を排土位置P1に向けて上昇させる。
ステップS211では、コントローラ27は、作業機12が掘削してバケット19が抱えている素材の重量を計測する。ここでは、コントローラ27は、作業機12にかかる負荷を示す負荷データを取得する。コントローラ27は、負荷データにより、素材の重量を算出する。
また、コントローラ27は、掘削前の地形データと、掘削経路PA1と、負荷データとから、素材の比重を算出する。掘削経路PA1は、掘削後の地形に相当する。従って、コントローラ27は、掘削前の地形データと掘削経路PA1とから、作業機12が掘削した素材の体積を算出する。コントローラ27は、素材の体積と、負荷データから算出した素材の重量とから、素材の比重を算出する。
図8に示すステップS301では、コントローラ27は、作業機械1の状態を判定する。ここでは、コントローラ27は、作業機械1が動作中であるのか、停止しているのかを判定する。コントローラ27は、走行体14、旋回体13、及び作業機12の少なくとも1つが動作しているときには、作業機械1が動作中であると判定する。コントローラ27は、作業機12の刃先が排土位置P1に到達しており、走行体14、旋回体13、及び作業機12の全て停止しているときに、作業機械1が停止していると判定する。或いは、コントローラ27は、旋回体13と走行体14とが停止しているときに、作業機械1が停止していると判定してもよい。
作業機械1が停止しているときには、コントローラ27は、ステップS302において画像処理3を実行する。画像処理3では、コントローラ27は、第1画像データに基づいて画像認識技術により運搬車両2を検出する。また、コントローラ27は、ステップS303において、運搬車両2と通信を行う。ここでは、ステップS107と同様に、コントローラ27は、運搬車両2の位置データと荷台データと旋回角度データとを、通信装置38を介して受信する。
そして、ステップS304において、コントローラ27は、運搬車両2の状態を判定する。ここでは、コントローラ27は、運搬車両2が動作中であるのか、積込位置L2で停止しているのかを判定する。コントローラ27は、運搬車両2が走行しているか、或いは、荷台53が旋回しているときには運搬車両2が動作中であると判定する。コントローラ27は、図16に示すように運搬車両2が積込位置L2に停車しており、且つ、荷台53が旋回せず停止しているときに、運搬車両2が停止していると判定する。
ステップS301において、作業機械1が停止しているときには、ステップS304において、コントローラ27は、画像処理3と、運搬車両2の位置データとに基づいて、運搬車両2の状態を判定する。従って、第1カメラ36と位置センサ33とは、運搬車両2の動作を検出する検出装置に相当する。コントローラ27は、第1画像データによって運搬車両2が停止しているかを判定する。また、コントローラ27は、運搬車両2の位置データによって運搬車両2が停止しているかを判定する。すなわち、第1画像データと運搬車両2の位置データとは、運搬車両2の動作を示す動作データに相当する。
例えば、コントローラ27は、画像処理3及び運搬車両2の位置データとの両方によって運搬車両2の停止が検出されたときに、運搬車両2が停止していると判定してもよい。コントローラ27は、画像処理3及び運搬車両2の位置データとの少なくとも一方によって、運搬車両2の動作が検出されたときに、運搬車両2が動作中であると判定してもよい。
一方、ステップS301において、作業機械1が動作中であるときには、コントローラ27は、ステップS305において運搬車両2の位置データを取得し、ステップ304において、運搬車両2の位置データのみによって運搬車両2の状態を判定する。
ステップ304において運搬車両2が動作中であるときには、処理はステップS301に戻る。ステップ304において運搬車両2が停止しているときには、処理はステップS306に進む。ステップS306では、コントローラ27は、画像処理4を実行する。画像処理4では、コントローラ27は、第1画像データに基づいて画像認識技術により運搬車両2の荷台位置を検出する。
図23は、運搬車両2が積込位置L2に停車したときに、第1カメラ36によって撮影された画像の一例を示す図である。図23に示すように、第1画像データが示す画像は、運搬車両2の荷台53を含む。第1画像データが示す画像に荷台53が含まれるときには、コントローラ27は、画像中の荷台53を認識して荷台位置を検出する。
ステップS307では、コントローラ27は、荷台位置の誤差を判定する。コントローラ27は、コントローラ27が記憶している荷台位置と、ステップS306で検出した荷台位置との偏差を算出する。コントローラ27は、偏差が所定の閾値以上であるときに、誤差が大きいと判定する。荷台位置の誤差が大きいときには、処理はステップS308に進む。
ステップS308では、コントローラ27は、排土位置P1を修正する。ここでは、コントローラ27は、ステップS209において決定した排土位置P1を、ステップS307で算出した偏差に基づいて修正する。ステップS307において荷台位置の誤差が小さいときには、排土位置P1の修正を行わずに、処理はステップS309に進む。
ステップS309では、コントローラ27は、自動排土を実行する。ここでは、コントローラ27は、バケット19が抱えている素材を荷台53上に排出するように、作業機12を動作させる。ステップS310では、コントローラ27は、荷台位置を更新する。コントローラ27は、記憶している荷台位置を、ステップS306で検出した荷台位置に更新する。
図9に示すステップS401では、コントローラ27は、積込が終了したかを判定する。コントローラ27は、荷台53に積み込まれた素材の重量(以下、「積込量」と呼ぶ)が許容重量に達したときに、積込が終了したと判定する。コントローラ27は、負荷データから積込量を算出する。詳細には、コントローラ27は、負荷データから掘削した素材の重量を算出する。コントローラ27は、荷台53に積み込まれた素材の重量の合計値を積込量として算出する。
ステップS401において、積込が終了していないとコントローラ27が判定したときには、処理はステップS201に戻る。そして、ステップS201からステップS211の処理、及び、ステップS301からステップS310の処理が繰り返される。それにより、素材の掘削と運搬車両2への積込とが繰り返される。
なお、2回目以降の掘削が行われるときも、コントローラ27は、ステップS201における地形の計測を改めて行い、地形センサ35が取得した新たな地形データによって、地形データを更新する。また、コントローラ27は、ステップS211における素材の重量の計測を再度行い、新たに計測した素材の重量と体積とから、素材の比重を算出して更新する。
ステップS401において、積込が終了したとコントローラ27が判定したときには、処理はステップS402に進む。ステップS402では、図17に示すように、コントローラ27は、運搬車両2に積込位置L2からの離脱指令を送信する。運搬車両2は、離脱指令を受信すると、積込位置L2からダンプ位置L3に向かって移動を開始する。
ステップS403では、コントローラ27は、画像処理2を実行する。ステップS106と同様に、画像処理2では、コントローラ27は、第1画像データに基づいて、画像認識技術により、旋回体13の前方における運搬車両2の存在を検出する。また、ステップS404において、コントローラ27は、運搬車両2と通信を行い、運搬車両2の位置データを取得する。ここでは、ステップS303及びステップS305と同様に、コントローラ27は、運搬車両2の位置データを通信装置38を介して受信する。
次にステップS405では、コントローラ27は、離脱が完了したかを判定する。コントローラ27は、画像処理2と運搬車両2の位置データとに基づいて、離脱が完了したかを判定する。図18に示すように、コントローラ27は、運搬車両2が作業機械1から所定距離以上、離れたことを検出したときに、離脱が完了したと判定する。
例えば、コントローラ27は、第1画像データに基づいて、作業機械1と運搬車両2との間の距離を算出する。コントローラ27は、位置データに基づいて、作業機械1と運搬車両2との間の距離を算出する。コントローラ27は、第1画像データから算出した距離と、位置データから算出した距離との両方が所定の閾値以上であるときに、運搬車両2が積込位置L2から離脱したと判定してもよい。或いは、コントローラ27は、第1画像データから算出した距離と、位置データから算出した距離との少なくとも一方が所定の閾値以上であるときに、運搬車両2が積込位置L2から離脱したと判定してもよい。
ステップS405において、コントローラ27が、離脱が完了していないと判定したときには、処理はステップS403に戻る。ステップS405において、コントローラ27が、離脱が完了したと判定したときには、処理はステップS109に戻る。すなわち、コントローラ27が、離脱が完了したと判定したときには、コントローラ27は、積込モードを終了して、自動制御モードを待機モードに遷移させる。
本態様に係る作業機械1の制御システムによれば、運搬車両2の動作が検出され、運搬車両2が積込位置L2で停止しているときに、作業機械1に排土を行わせることができる。そのため、作業機械1と運搬車両2とが適切に連携して作業を行うことができる。それにより、作業機械1による積込作業を自動制御によって行うと共に、作業効率を向上させることができる。
コントローラ27は、作業機械1が停止していると判定したときには、第1画像データに基づいて運搬車両2の停止を判定する。また、コントローラ27は、作業機械1が動作中であると判定したときには、運搬車両2の位置データに基づいて運搬車両2の停止を判定する。作業機械1が動作中であるときには、作業機械1と共に第1カメラ36が動くため、第1画像データによる画像認識の精度が低下する。そのため、作業機械1が動作中であるときには、運搬車両2の位置データを用いることで、運搬車両2の停止を精度よく判定することができる。
コントローラ27は、運搬車両2の位置データから算出した荷台53の位置と、第1画像データから算出した荷台53の位置との誤差が所定の閾値より大きいときには、第1画像データから算出した荷台53の位置に基づいて、排土位置を修正する。それにより、荷台53に対して精度良く排土位置を決定することができる。
コントローラ27は、旋回体13の停止と動作とを判定し、旋回体13が停止していると判定したときに、地形センサ35による地形の計測を行う。旋回体13が旋回しているときには、旋回体13と共に地形センサ35が動くため、地形センサ35による地形の検出精度が低下する。そのため、コントローラ27は、旋回体13が停止していると判定したときに、地形センサ35による地形の計測を行うことで、地形の検出精度を向上させることができる。
以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。
作業機械1は、油圧ショベルに限らず、ホイールローダ、或いはモータグレーダ等の他の機械であってもよい。作業機械1の構成は、上記の実施形態のものに限らず、変更されてもよい。作業機械1は、電動モータで駆動される車両であってもよい。例えば、走行体14及び/又は旋回体13は、電動モータで駆動されてもよい。作業機12の構成が変更されてもよい。例えば、作業機12は、バケット19に限らず、グラップル、フォーク、リフティングマグネットなどの他の積込用アタッチメントを含んでもよい。
運搬車両2は、ダンプトラック以外の車両であってもよい。運搬車両2の構成は、上記の実施形態のものに限らず、変更されてもよい。例えば、運搬車両2は、電動モータで駆動される車両であってもよい。例えば、走行体14及び/又は荷台53は、電動モータで駆動されてもよい。運搬車両2の荷台53は旋回不能であってもよい。運搬車両2の走行体52は、履帯ではなく、タイヤを備えてもよい。運搬車両2は自動制御ではなく、オペレータによって手動で運転されてもよい。
作業機械1及び運搬車両2に備えられる各種のセンサの構成は、上記の実施形態のものに限らず、変更されてもよい。例えば、地形センサ35は、旋回体13の側部以外の部分に配置されてもよい。地形センサ35は、ライダに限らず、レーダーなどの他のセンシング装置であってもよい。或いは、地形センサ35はカメラであり、コントローラ27は、カメラが撮影した画像を解析することで、地形を認識してもよい。
第1カメラ36は、旋回体13の前部以外の部分に配置されてもよい。第2カメラ37は、旋回体13の両側部及び後部以外の部分に配置されてもよい。第2カメラの数は3つに限らず、3つより少ない、或いは3つより多くてもよい。
コントローラ27は、一体に限らず、複数のコントローラ27に分かれていてもよい。コントローラ27によって実行される処理は、複数のコントローラ27に分散して実行されてもよい。その場合、複数のコントローラ27の一部は、作業機械1の外部に配置されてもよい。
作業機械1のコントローラ27と運搬車両2のコントローラ61とは、互いに直接的に通信するのではなく、他のコントローラを介して通信してもよい。コントローラ27によって実行される自動制御モードの処理は、上述した実施形態のものに限らず、変更されてもよい。例えば、待機モードでの処理が変更されてもよい。積込モードでの処理が変更されてもよい。
上記の実施形態では、コントローラ27は、第1画像データと運搬車両2の位置データとの両方を用いて、運搬車両2の接近及び離脱を判定している。しかし、コントローラ27は、第1画像データと運搬車両2の位置データとのいずれか一方のみを用いて、運搬車両2の接近、及び/又は、離脱を判定してもよい。
上記の実施形態では、コントローラ27は、第1画像データと運搬車両2の位置データとの両方を用いて、積込位置L2での運搬車両2の停止を判定している。しかし、コントローラ27は、第1画像データと運搬車両2の位置データとのいずれか一方のみを用いて、運搬車両2の停止を判定してもよい。
上記の実施形態では、コントローラ27は、第1画像データと運搬車両2の位置データとの両方を用いて、荷台53の位置を検出している。しかし、コントローラ27は、第1画像データと運搬車両2の位置データとのいずれか一方のみを用いて、荷台53の位置を検出してもよい。
上記の実施形態では、コントローラ27は、負荷センサ32a-32cが検出した負荷データによって積込可能重量を算出している。しかし、コントローラ27は、第1画像データが示す荷台53の画像に基づいて、積込可能重量を算出してもよい。コントローラ27は、第1画像データが示す荷台53の画像から、荷台53に積み込まれた素材の量を検出して、積み込まれた素材の量から積込可能重量を算出してもよい。
本発明によれば、作業機械による積込作業を自動制御によって行うと共に、作業機械と運搬車両との連携を適切に行うことができる。
1 作業機械
2 運搬車両
12 作業機
13 旋回体
27 コントローラ
35 地形センサ
36 第1カメラ
53 荷台
63 位置センサ
L2 積込位置

Claims (6)

  1. 運搬車両に素材を積み込む作業機械を制御するためのシステムであって、
    前記運搬車両の動作を検出する検出装置と、
    前記作業機械を制御するコントローラと、
    を備え、
    前記コントローラは、
    前記運搬車両の動作を示す動作データを前記検出装置から取得し、
    前記動作データに基づいて、所定の積込位置での前記運搬車両の停止を判定し、
    前記運搬車両が前記積込位置で停止していると判定したときに、前記作業機械を制御して排土させ
    前記検出装置は、前記作業機械の周囲を撮影するカメラを含み、
    前記運搬車両は、前記運搬車両の位置を検出する位置センサを含み、
    前記動作データは、前記カメラが撮影した前記作業機械の周囲の動画を示す画像データと、前記位置センサが検出した前記運搬車両の位置を示す位置データとを含み、
    前記コントローラは、
    前記作業機械の停止と前記作業機械の動作とを判定し、
    前記作業機械が停止していると判定したときには、前記画像データに基づいて前記運搬車両の停止を判定し、
    前記作業機械が動作中であると判定したときには、前記位置データに基づいて前記運搬車両の停止を判定する、
    システム。
  2. 運搬車両に素材を積み込む作業機械を制御するためのシステムであって、
    前記運搬車両の動作を検出する検出装置と、
    前記作業機械を制御するコントローラと、
    を備え、
    前記コントローラは、
    前記運搬車両の動作を示す動作データを前記検出装置から取得し、
    前記動作データに基づいて、所定の積込位置での前記運搬車両の停止を判定し、
    前記運搬車両が前記積込位置で停止していると判定したときに、前記作業機械を制御して排土させ、
    前記検出装置は、前記作業機械の周囲を撮影するカメラを含み、
    前記運搬車両は、前記運搬車両の位置を検出する位置センサを含み、
    前記動作データは、前記カメラが撮影した前記作業機械の周囲の動画を示す画像データと、前記位置センサが検出した前記運搬車両の位置を示す位置データとを含み、
    前記作業機械は、
    作業機と、
    前記作業機が取り付けられた旋回体と、
    を含み、
    前記コントローラは、
    所定の排土位置に向けて前記旋回体を旋回させ、
    前記運搬車両が動作中であると判定したときには、前記作業機を前記排土位置で待機させ、
    前記運搬車両が停止していると判定したときに、前記作業機を制御して前記排土位置において排土させ
    前記位置データに基づいて前記運搬車両の荷台の位置を算出し、
    前記画像データに基づいて前記運搬車両の荷台の位置を算出し、
    前記位置データから算出した前記荷台の位置と、前記画像データから算出した前記荷台の位置との誤差が所定の閾値より大きいときには、前記画像データから算出した前記荷台の位置に基づいて、前記排土位置を修正する
    ステム。
  3. 運搬車両に素材を積み込む作業機械を制御するためのシステムであって、
    前記運搬車両の動作を検出する検出装置と、
    前記作業機械を制御するコントローラと、
    を備え、
    前記コントローラは、
    前記運搬車両の動作を示す動作データを前記検出装置から取得し、
    前記動作データに基づいて、所定の積込位置での前記運搬車両の停止を判定し、
    前記運搬車両が前記積込位置で停止していると判定したときに、前記作業機械を制御して排土させ、
    前記作業機械は、
    作業機と、
    前記作業機が取り付けられた旋回体と、
    前記作業機械の周囲の地形を計測する地形センサと、
    を含み、
    前記コントローラは、
    前記地形センサが計測した前記地形を示す地形データを取得し、
    前記地形センサが計測した前記地形に基づいて、掘削開始位置を決定し、
    前記運搬車両の接近を検出したときに、前記掘削開始位置に向けて前記旋回体を旋回させ、
    前記掘削開始位置において掘削を行うよう前記作業機を制御し、
    前記地形センサは、前記旋回体に取り付けられており、
    前記コントローラは、
    前記旋回体の停止と動作とを判定し、
    前記旋回体が停止していると判定したときに、前記地形センサによる地形の計測を行う
    ステム。
  4. 運搬車両に素材を積み込む作業機械を制御するためにコントローラによって実行される方法であって、
    前記運搬車両の動作を示す動作データを取得することと、
    前記動作データに基づいて、所定の積込位置での前記運搬車両の停止を判定することと、
    前記運搬車両が前記積込位置で停止していると判定したときに、前記作業機械を制御して排土させることと、
    前記作業機械の停止と前記作業機械の動作とを判定すること、
    を備え
    前記動作データは、前記作業機械の周囲の動画を示す画像データと、前記運搬車両の位置を示す位置データとを含み、
    前記運搬車両の停止を判定することは、
    前記作業機械が停止していると判定したときに、前記画像データに基づいて前記運搬車両の停止を判定することと、
    前記作業機械が動作中であると判定したときに、前記位置データに基づいて前記運搬車両の停止を判定すること、
    を含む、
    方法。
  5. 運搬車両に素材を積み込む作業機械を制御するためにコントローラによって実行される方法であって、
    前記作業機械は、
    作業機と、
    前記作業機が取り付けられた旋回体と、
    を含み、
    前記作業機械の周囲の動画を示す画像データと、前記運搬車両の位置を示す位置データとを含む動作データを取得することと、
    前記動作データに基づいて、所定の積込位置での前記運搬車両の停止を判定することと、
    所定の排土位置に向けて前記旋回体を旋回させることと、
    前記運搬車両が動作中であると判定したときには、前記作業機を前記排土位置で待機させることと、
    前記運搬車両が前記積込位置で停止していると判定したときには、前記作業機を制御して前記排土位置において排土させることと、
    前記位置データに基づいて前記運搬車両の荷台の位置を算出することと、
    前記画像データに基づいて前記運搬車両の荷台の位置を算出することと、
    前記位置データから算出した前記荷台の位置と、前記画像データから算出した前記荷台の位置との誤差が所定の閾値より大きいときには、前記画像データから算出した前記荷台の位置に基づいて、前記排土位置を修正すること、
    を備える方法。
  6. 前記作業機械は、
    作業機と、
    前記作業機が取り付けられた旋回体と、
    を含み、
    前記方法は、
    前記作業機械の周囲の地形を示す地形データを取得することと、
    前記地形データに基づいて、掘削開始位置を決定することと、
    前記運搬車両の接近を検出したときに、前記掘削開始位置に向けて前記旋回体を旋回させることと、
    前記掘削開始位置において掘削を行うよう前記作業機を制御すること、
    をさらに備える、
    請求項に記載の方法。
JP2018144232A 2018-07-31 2018-07-31 作業機械を制御するためのシステム及び方法 Active JP7204366B2 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP2018144232A JP7204366B2 (ja) 2018-07-31 2018-07-31 作業機械を制御するためのシステム及び方法
US16/980,709 US11795658B2 (en) 2018-07-31 2019-03-15 System and method for controlling work machine
DE112019000997.4T DE112019000997T5 (de) 2018-07-31 2019-03-15 System und Verfahren zur Steuerung einer Arbeitsmaschine
PCT/JP2019/010992 WO2020026507A1 (ja) 2018-07-31 2019-03-15 作業機械を制御するためのシステム及び方法
CN201980015056.5A CN111771031B (zh) 2018-07-31 2019-03-15 用于控制作业机械的系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018144232A JP7204366B2 (ja) 2018-07-31 2018-07-31 作業機械を制御するためのシステム及び方法

Publications (2)

Publication Number Publication Date
JP2020020155A JP2020020155A (ja) 2020-02-06
JP7204366B2 true JP7204366B2 (ja) 2023-01-16

Family

ID=69231141

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018144232A Active JP7204366B2 (ja) 2018-07-31 2018-07-31 作業機械を制御するためのシステム及び方法

Country Status (5)

Country Link
US (1) US11795658B2 (ja)
JP (1) JP7204366B2 (ja)
CN (1) CN111771031B (ja)
DE (1) DE112019000997T5 (ja)
WO (1) WO2020026507A1 (ja)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021156080A (ja) * 2020-03-30 2021-10-07 住友重機械工業株式会社 施工支援システム及び施工支援装置
CN115427639A (zh) * 2020-05-25 2022-12-02 住友建机株式会社 挖土机及挖土机用的系统
CN111733920B (zh) * 2020-06-30 2021-03-09 北京建工环境修复股份有限公司 一种智能上料控制系统及其控制方法
JP7484623B2 (ja) * 2020-09-25 2024-05-16 コベルコ建機株式会社 停止指示システム
JP2022054119A (ja) * 2020-09-25 2022-04-06 コベルコ建機株式会社 自動積込システム
CN112709269A (zh) * 2020-12-22 2021-04-27 中联重科土方机械有限公司 挖掘机姿态调整的自动控制装置、方法及挖掘机
JP2022160163A (ja) * 2021-04-06 2022-10-19 コベルコ建機株式会社 作業機械
CN114855899B (zh) * 2022-05-12 2023-06-23 南京工业大学 一种挖掘机工作阶段及工况识别方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008240461A (ja) 2007-03-28 2008-10-09 Komatsu Ltd 過積載防止システムおよび過積載防止方法
JP2013025527A (ja) 2011-07-20 2013-02-04 Nissan Motor Co Ltd 運転支援用の通信タグ及び運転支援システム
JP2013073517A (ja) 2011-09-28 2013-04-22 Sumitomo Heavy Ind Ltd 物体検出装置を搭載する移動体
WO2013058247A1 (ja) 2011-10-17 2013-04-25 日立建機株式会社 ダンプトラック停車位置方向指示システムおよび運搬システム
JP2014016883A (ja) 2012-07-10 2014-01-30 Toyota Infotechnology Center Co Ltd 危険個所報知システムおよび危険個所報知方法
WO2017109977A1 (ja) 2015-12-25 2017-06-29 株式会社小松製作所 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法
JP2018031202A (ja) 2016-08-25 2018-03-01 大林道路株式会社 加熱アスファルト混合物の敷均し装置

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2742839B2 (ja) * 1991-07-01 1998-04-22 日工株式会社 アスファルト合材サイロの合材積込み方法
JP2742840B2 (ja) * 1991-07-01 1998-04-22 日工株式会社 アスファルトプラントの合材積込み方法
JP2711612B2 (ja) * 1992-04-20 1998-02-10 株式会社フジタ 土工事の自動搬送システム
JP2000192514A (ja) 1998-12-28 2000-07-11 Hitachi Constr Mach Co Ltd 自動運転建設機械およびその運転方法
JP5140864B2 (ja) * 2010-11-22 2013-02-13 株式会社小松製作所 無人車両の走行システムおよび走行経路生成方法
WO2013065415A1 (ja) * 2011-11-04 2013-05-10 株式会社小松製作所 積載システム及び運搬機
CA2923683C (en) 2013-12-12 2018-03-13 Hitachi Construction Machinery Co., Ltd. Vehicle travel system and vehicle travel control method
KR20180042251A (ko) 2015-08-26 2018-04-25 스미토모 겐키 가부시키가이샤 쇼벨의 계측장치
CN108169765B (zh) 2016-12-07 2020-08-21 法法汽车(中国)有限公司 提高自动驾驶可靠性的方法及电子设备
CN107740448A (zh) 2017-11-30 2018-02-27 南京工业大学 一种无人自动化挖掘机智能施工系统
JPWO2019189260A1 (ja) * 2018-03-27 2021-04-01 住友重機械工業株式会社 ショベル
US11226627B2 (en) * 2019-06-20 2022-01-18 Caterpillar Global Mining Llc System for modifying a spot location

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008240461A (ja) 2007-03-28 2008-10-09 Komatsu Ltd 過積載防止システムおよび過積載防止方法
JP2013025527A (ja) 2011-07-20 2013-02-04 Nissan Motor Co Ltd 運転支援用の通信タグ及び運転支援システム
JP2013073517A (ja) 2011-09-28 2013-04-22 Sumitomo Heavy Ind Ltd 物体検出装置を搭載する移動体
WO2013058247A1 (ja) 2011-10-17 2013-04-25 日立建機株式会社 ダンプトラック停車位置方向指示システムおよび運搬システム
JP2014016883A (ja) 2012-07-10 2014-01-30 Toyota Infotechnology Center Co Ltd 危険個所報知システムおよび危険個所報知方法
WO2017109977A1 (ja) 2015-12-25 2017-06-29 株式会社小松製作所 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法
JP2018031202A (ja) 2016-08-25 2018-03-01 大林道路株式会社 加熱アスファルト混合物の敷均し装置

Also Published As

Publication number Publication date
US11795658B2 (en) 2023-10-24
JP2020020155A (ja) 2020-02-06
US20210010237A1 (en) 2021-01-14
DE112019000997T5 (de) 2020-11-05
CN111771031B (zh) 2022-07-08
CN111771031A (zh) 2020-10-13
WO2020026507A1 (ja) 2020-02-06

Similar Documents

Publication Publication Date Title
JP7274831B2 (ja) 作業機械
JP7204366B2 (ja) 作業機械を制御するためのシステム及び方法
JP7199865B2 (ja) 作業機械を制御するためのシステム及び方法
JP7156898B2 (ja) 運搬車両と運搬車両に素材を積み込む作業機械とを含むシステム、方法、及び作業機械
JP7265323B2 (ja) 作業機械を制御するためのシステム及び方法
JP7199864B2 (ja) 作業機械を制御するためのシステム及び方法
JP7236826B2 (ja) 作業機械
US11879232B2 (en) System and method for controlling work machine that loads materials onto conveyance vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210607

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220712

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220826

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221228

R150 Certificate of patent or registration of utility model

Ref document number: 7204366

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150