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

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

Info

Publication number
JP7265323B2
JP7265323B2 JP2018144229A JP2018144229A JP7265323B2 JP 7265323 B2 JP7265323 B2 JP 7265323B2 JP 2018144229 A JP2018144229 A JP 2018144229A JP 2018144229 A JP2018144229 A JP 2018144229A JP 7265323 B2 JP7265323 B2 JP 7265323B2
Authority
JP
Japan
Prior art keywords
controller
work machine
revolving body
loading
work
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
JP2018144229A
Other languages
English (en)
Other versions
JP2020020152A (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 JP2018144229A priority Critical patent/JP7265323B2/ja
Priority to PCT/JP2019/010888 priority patent/WO2020026504A1/ja
Priority to DE112019000845.5T priority patent/DE112019000845T5/de
Priority to CN201980015037.2A priority patent/CN111771034B/zh
Priority to US16/971,790 priority patent/US11788254B2/en
Publication of JP2020020152A publication Critical patent/JP2020020152A/ja
Application granted granted Critical
Publication of JP7265323B2 publication Critical patent/JP7265323B2/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/2033Limiting the movement of frames or implements, e.g. to avoid collision between implements and the cabin
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04NPICTORIAL COMMUNICATION, e.g. TELEVISION
    • H04N7/00Television systems
    • H04N7/18Closed-circuit television [CCTV] systems, i.e. systems in which the video signal is not broadcast
    • H04N7/181Closed-circuit television [CCTV] systems, i.e. systems in which the video signal is not broadcast for receiving images from a plurality of remote sources
    • 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/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • E02F9/205Remotely operated machines, e.g. unmanned vehicles
    • 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
    • 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
    • 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
    • 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
    • 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

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が人の存在を検出して作業機械1及び運搬車両2を停止させた後、オペレータの操作によりリモートコンピュータ機器4から自動制御モードの開始指令を受信すると、コントローラ27は、作業機械1及び運搬車両2の動作を再開させてもよい。
次に、積込モードでの処理について説明する。コントローラ27は、積込モードにおいて、所定の掘削位置L1で作業機12による掘削を行い、掘削位置L1から積込位置L2に向けて旋回体13と旋回させ、積込位置L2で作業機12から排土することで、積込作業を行う。図7に示すように、積込モードでは、ステップS201において、コントローラ27は、地形を計測する。ここでは、図13に示すように、地形センサ35が、作業機械1の側方に位置する掘削位置L1の地形を計測する。コントローラ27は、地形センサ35が計測した掘削位置L1の地形を示す地形データを取得する。
なお、コントローラ27は、旋回体13が停止しているのか、或いは動作しているのかを判定し、旋回体13が停止していると判定したときに、地形センサ35による地形の計測を行ってもよい。旋回体13が動作中であるときには、旋回体13と共に地形センサ35も動く。そのため、地形センサ35による地形の計測の精度が低くなる。従って、旋回体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と位置センサ63とは、運搬車両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の制御システムでは、待機モードから積込モードに遷移するための遷移条件が、作業機械1の周囲の領域における人の不検知を含む。そのため、コントローラ27は、第1カメラ36又は第2カメラ37が撮影した画像により、作業機械1の周囲に人が居ないことを確認した上で、自動制御モードを待機モードから積込モードに遷移させることができる。それにより、作業機械1による積込作業を自動制御によって行うと共に、積込作業において安全性をさらに向上させることができる。
コントローラ27は、積込モード中に人の存在を検出したときには、作業機12及び旋回体13の動作を停止させる。従って、積込作業中に作業機械1の周囲に人が侵入したときには、作業機械1が停止され、積込作業が中断される。それにより、積込作業において安全性をさらに向上させることができる。
以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。
作業機械1は、油圧ショベルに限らず、ホイールローダ、或いはモータグレーダ等の他の機械であってもよい。作業機械1の構成は、上記の実施形態のものに限らず、変更されてもよい。作業機械1は、電動モータで駆動される車両であってもよい。例えば、走行体14及び/又は旋回体13は、電動モータで駆動されてもよい。作業機12の構成が変更されてもよい。例えば、作業機12は、バケット19に限らず、グラップル、フォーク、リフティングマグネットなどの他の積込用アタッチメントを含んでもよい。
運搬車両2は、ダンプトラック以外の車両であってもよい。運搬車両2の構成は、上記の実施形態のものに限らず、変更されてもよい。例えば、運搬車両2は、電動モータで駆動される車両であってもよい。例えば、走行体52及び/又は荷台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によって実行される処理は、複数のコントローラに分散して実行されてもよい。その場合、複数のコントローラの一部は、作業機械1の外部に配置されてもよい。
作業機械1のコントローラ27と運搬車両2のコントローラ61とは、互いに直接的に通信するのではなく、他のコントローラを介して通信してもよい。コントローラ27によって実行される自動制御モードの処理は、上述した実施形態のものに限らず、変更されてもよい。例えば、待機モードでの処理が変更されてもよい。積込モードでの処理が変更されてもよい。
上記の実施形態では、コントローラ27は、第1画像データと運搬車両2の位置データとの両方を用いて、運搬車両2の接近及び離脱を判定している。しかし、コントローラ27は、第1画像データと運搬車両2の位置データとのいずれか一方のみを用いて、運搬車両2の接近、及び/又は、離脱を判定してもよい。
上記の実施形態では、コントローラ27は、第1画像データと運搬車両2の位置データとの両方を用いて、荷台53の位置を検出している。しかし、コントローラ27は、第1画像データと運搬車両2の位置データとのいずれか一方のみを用いて、荷台53の位置を検出してもよい。
上記の実施形態では、コントローラ27は、負荷センサ32a-32cが検出した負荷データによって積込可能重量を算出している。しかし、コントローラ27は、第1画像データが示す荷台53の画像に基づいて、積込可能重量を算出してもよい。コントローラ27は、第1画像データが示す荷台53の画像から、荷台53に積み込まれた素材の量を検出して、積み込まれた素材の量から積込可能重量を算出してもよい。
上記の実施形態では、コントローラ27は、第1画像データ又は第2画像データが示す画像に人100が含まれるときに、人100の存在を検出する。しかし、コントローラ27は、作業機械1から人100までの距離を検出し、距離に応じて人100が存在するかを判定してもよい。例えば、コントローラ27は、作業機械1から人100までの距離が所定の閾値以下であるときに、人100が存在すると判定してもよい。
上記の実施形態では、コントローラ27は、積込モード中に人100の存在を検出したときには、作業機12及び旋回体13の動作を停止させている。しかし、コントローラ27は、積込モード中に人100の存在を検出したときに、作業機12と旋回体13といずれか一方のみの動作を停止させてもよい。
或いは、コントローラ27は、人100が検出された位置に応じて、積込モード中の作業機械1の制御を変更してもよい。図24に示すように、コントローラ27は、積込モード中に作業機械1の周囲の第1領域A1内に人100の存在を検出したときには、旋回体13の動作を停止させてもよい。この場合、コントローラ27は、作業機12の動作を許容してもよい。コントローラ27は、積込モード中に作業機12の周辺の第2領域A2内に人100の存在を検出したときには、作業機12及び旋回体13の動作を停止させてもよい。第2領域A2は、第1領域A1と異なる領域である。ただし、第2領域A2の一部が、第1領域A1と重なってもよい。
詳細には、第1領域A1は、旋回体13の回転中心周りの所定の第1角度範囲である。第2領域A2は、旋回体13の回転中心周りの所定の第2角度範囲であり、第2角度範囲は、第1角度範囲よりも狭い。第2角度範囲は、例えば旋回体13の回転中心を中心とする90度以下の範囲であり、第2領域A2は、旋回体13に対して作業機12が配置された方向を含む。すなわち、第2領域A2は、旋回体13の前方に位置する第1領域A1より角度範囲の狭い領域である。第1角度範囲は、旋回体13の回転中心を中心とする360度の範囲のうち、第2角度範囲を除く範囲である。
ただし、旋回体13の回転中心を中心とする第2領域A2の半径R2は、旋回体13の回転中心を中心とする第1領域A1の半径R1よりも大きい。すなわち、第2領域A2は、旋回体13の回転中心を中心とする径方向において、第1領域A1よりも大きい。
第1領域A1の半径R1は、旋回体13の旋回半径R3よりも大きい。これは、コントローラ27が旋回体13を停止させる指令を出力しても、惰性により数秒間は旋回体13が旋回し続けることによる。すなわち、第1領域A1の半径R1が、旋回体13の旋回半径R3よりも大きいことにより、人100が旋回体13の旋回範囲内に到達する前に、旋回体13を停止させることができる。また、第2領域A2の半径R2は、作業機12を最大に伸ばしたときの作業機12の旋回半径R4よりも大きい。これにより、人100が作業機12の旋回範囲内に到達する前に、旋回体13を停止させることができる。
本発明によれば、作業機械による積込作業を自動制御によって行うと共に、積込作業において安全性をさらに向上させることができる。
1 作業機械
2 運搬車両
4 リモートコンピュータ機器
12 作業機
13 旋回体
27 コントローラ
36 第1カメラ
37 第2カメラ
A1 第1領域
A2 第2領域

Claims (8)

  1. 運搬車両に素材を積み込む作業機械を制御するためのシステムであって、
    自動で作業を行う自動制御モードにて前記作業機械を制御するコントローラと、
    前記作業機械の周囲の領域における人の存在を検出する検出装置と、
    を備え、
    前記作業機械は、
    作業機と、
    前記作業機が取り付けられた旋回体と、
    を含み、
    前記自動制御モードは、前記運搬車両への積込作業を行うように前記作業機械を動作させる積込モードと、前記積込モード以外の他のモードとを含み、
    前記コントローラは、所定の遷移条件が満たされているときに、前記自動制御モードを前記他のモードから前記積込モードに遷移させ、
    前記所定の遷移条件は、前記検出装置による人の不検出を含み、
    前記積込モード中に、前記検出装置が前記作業機械の周囲の第1領域内に人の存在を検出したときには、前記コントローラは、前記旋回体の動作を停止させるが、前記作業機の動作を許容し、
    前記積込モード中に、前記検出装置が前記作業機の周辺の第2領域内に人の存在を検出したときには、前記コントローラは、前記作業機及び前記旋回体の動作を停止させ、
    前記第1領域は、前記旋回体の回転中心周りの所定の第1角度範囲であり、
    前記第2領域は、前記旋回体の回転中心周りの所定の第2角度範囲であり、
    前記第2領域は、前記旋回体に対して作業機が配置された方向を含み、
    前記第1角度範囲は、前記旋回体の回転中心を中心とする360度の範囲のうち、前記第2角度範囲を除く範囲を含む、
    システム。
  2. 記第2角度範囲は、前記第1角度範囲よりも狭い、
    請求項1に記載のシステム。
  3. 前記旋回体の回転中心を中心とする前記第2領域の半径は、前記旋回体の回転中心を中心とする前記第1領域の半径よりも大きい、
    請求項1又は2に記載のシステム。
  4. 前記コントローラと通信可能な出力装置をさらに備え、
    前記検出装置が人の存在を検出したときには、前記コントローラは、警報を出力させるよう前記出力装置を制御する、
    請求項1からのいずれかに記載のシステム。
  5. 前記検出装置は、前記作業機械の周囲を撮影するカメラを含み、
    前記コントローラは、
    前記カメラが撮影した前記作業機械の周囲の画像を示す画像データを取得し、
    前記画像データに基づいて、前記人の存在を検出する、
    請求項1からのいずれかに記載のシステム。
  6. 運搬車両に素材を積み込む作業機械を制御するためにコントローラによって実行される方法であって、
    前記作業機械は、
    作業機と、
    前記作業機が取り付けられた旋回体と、
    を含み、
    前記運搬車両への積込作業を行うように前記作業機械を動作させる積込モードと、前記積込モード以外の他のモードを含み、自動で作業を行う自動制御モードにて前記作業機械を制御することと、
    前記作業機械の周囲の領域における人の存在を検出することと、
    前記人の存在を検出しないことを含む所定の遷移条件が満たされているときに、前記自動制御モードを前記他のモードから前記積込モードに遷移させること、
    を備え、
    前記作業機械を制御することは、
    前記積込モード中に、前記作業機械の周囲の第1領域内に人の存在を検出したときに、前記旋回体の動作を停止させるが、前記作業機の動作を許容することと、
    前記積込モード中に、前記作業機械の周囲の第2領域内に人の存在を検出したときに、前記作業機及び前記旋回体の動作を停止させること、
    を含み、
    前記第1領域は、前記旋回体の回転中心周りの所定の第1角度範囲であり、
    前記第2領域は、前記旋回体の回転中心周りの所定の第2角度範囲であり、
    前記第2領域は、前記旋回体に対して作業機が配置された方向を含み、
    前記第1角度範囲は、前記旋回体の回転中心を中心とする360度の範囲のうち、前記第2角度範囲を除く範囲を含む、
    方法。
  7. 記第2角度範囲は、前記第1角度範囲よりも狭い、
    請求項に記載の方法。
  8. 前記旋回体の回転中心を中心とする前記第2領域の半径は、前記旋回体の回転中心を中心とする前記第1領域の半径よりも大きい、
    請求項6又は7に記載の方法。
JP2018144229A 2018-07-31 2018-07-31 作業機械を制御するためのシステム及び方法 Active JP7265323B2 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP2018144229A JP7265323B2 (ja) 2018-07-31 2018-07-31 作業機械を制御するためのシステム及び方法
PCT/JP2019/010888 WO2020026504A1 (ja) 2018-07-31 2019-03-15 作業機械を制御するためのシステム及び方法
DE112019000845.5T DE112019000845T5 (de) 2018-07-31 2019-03-15 System und verfahren zum steuern einer arbeitsmaschine
CN201980015037.2A CN111771034B (zh) 2018-07-31 2019-03-15 用于控制作业机械的系统以及方法
US16/971,790 US11788254B2 (en) 2018-07-31 2019-03-15 System and method for controlling work machine

Applications Claiming Priority (1)

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

Publications (2)

Publication Number Publication Date
JP2020020152A JP2020020152A (ja) 2020-02-06
JP7265323B2 true JP7265323B2 (ja) 2023-04-26

Family

ID=69232444

Family Applications (1)

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

Country Status (5)

Country Link
US (1) US11788254B2 (ja)
JP (1) JP7265323B2 (ja)
CN (1) CN111771034B (ja)
DE (1) DE112019000845T5 (ja)
WO (1) WO2020026504A1 (ja)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7153627B2 (ja) * 2019-10-31 2022-10-14 日立建機株式会社 作業機械および周囲監視システム
JP2022054119A (ja) * 2020-09-25 2022-04-06 コベルコ建機株式会社 自動積込システム
AU2021202152A1 (en) * 2021-04-08 2022-10-27 Caterpillar Underground Mining Pty Ltd System, apparatus, and method to select and apply route properties of a mine site

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000192514A (ja) 1998-12-28 2000-07-11 Hitachi Constr Mach Co Ltd 自動運転建設機械およびその運転方法
JP2002004343A (ja) 2000-06-26 2002-01-09 Shinkichi Yamazaki 建設機械の緊急自動停止装置
JP2016089559A (ja) 2014-11-10 2016-05-23 日立建機株式会社 建設機械
WO2016121010A1 (ja) 2015-01-28 2016-08-04 株式会社日立製作所 作業機械の操作システム
JP2017145564A (ja) 2016-02-15 2017-08-24 株式会社神戸製鋼所 可動機械の安全装置

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05125748A (ja) * 1991-10-14 1993-05-21 Nippon Telegr & Teleph Corp <Ntt> 建設機械およびその制御方法
JP2711612B2 (ja) 1992-04-20 1998-02-10 株式会社フジタ 土工事の自動搬送システム
AU2002344089B2 (en) * 2001-10-18 2006-06-22 Hitachi Construction Machinery Co., Ltd. Hydraulic shovel work amount detection apparatus, work amount detection method, work amount detection result display apparatus
JP2008179940A (ja) * 2005-03-31 2008-08-07 Hitachi Constr Mach Co Ltd 作業機械の周囲監視装置
US20090043462A1 (en) * 2007-06-29 2009-02-12 Kenneth Lee Stratton Worksite zone mapping and collision avoidance system
WO2011049079A1 (ja) * 2009-10-19 2011-04-28 日立建機株式会社 作業機械
US9580885B2 (en) * 2011-10-19 2017-02-28 Sumitomo Heavy Industries, Ltd. Swing operating machine and method of controlling swing operating machine
JP5629740B2 (ja) * 2012-09-21 2014-11-26 株式会社小松製作所 作業車両用周辺監視システム及び作業車両
JP5324690B1 (ja) 2012-09-21 2013-10-23 株式会社小松製作所 作業車両用周辺監視システム及び作業車両
JP6386794B2 (ja) * 2014-06-04 2018-09-05 日立建機株式会社 運搬車両
JP6353322B2 (ja) * 2014-09-04 2018-07-04 日立建機株式会社 運搬車両及びその走行制御装置
JP6456173B2 (ja) * 2015-02-04 2019-01-23 日立建機株式会社 車体外部移動物体検知装置
US10520320B2 (en) * 2015-12-25 2019-12-31 Komatsu Ltd. Management system for work machine, work machine, and management device for work machine
JP6267783B2 (ja) * 2016-02-01 2018-01-24 株式会社小松製作所 作業機械の制御システム、作業機械、及び作業機械の管理システム
WO2017175361A1 (ja) * 2016-04-07 2017-10-12 株式会社小松製作所 走行車両及び走行車両の制御方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000192514A (ja) 1998-12-28 2000-07-11 Hitachi Constr Mach Co Ltd 自動運転建設機械およびその運転方法
JP2002004343A (ja) 2000-06-26 2002-01-09 Shinkichi Yamazaki 建設機械の緊急自動停止装置
JP2016089559A (ja) 2014-11-10 2016-05-23 日立建機株式会社 建設機械
WO2016121010A1 (ja) 2015-01-28 2016-08-04 株式会社日立製作所 作業機械の操作システム
JP2017145564A (ja) 2016-02-15 2017-08-24 株式会社神戸製鋼所 可動機械の安全装置

Also Published As

Publication number Publication date
WO2020026504A1 (ja) 2020-02-06
US20200392701A1 (en) 2020-12-17
JP2020020152A (ja) 2020-02-06
CN111771034B (zh) 2022-04-26
CN111771034A (zh) 2020-10-13
US11788254B2 (en) 2023-10-17
DE112019000845T5 (de) 2020-10-29

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

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20221213

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230126

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230414

R150 Certificate of patent or registration of utility model

Ref document number: 7265323

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150