特許 7141843 作業機械の制御装置及び作業機械の制御方法

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】特許公報(B2)

(11)【特許番号】

(24)【登録日】2022-09-14

(45)【発行日】2022-09-26

(54)【発明の名称】作業機械の制御装置及び作業機械の制御方法

(51)【国際特許分類】

   E02F 9/20 20060101AFI20220915BHJP

【ＦＩ】

E02F9/20 C

【請求項の数】 5

(21)【出願番号】P 2018070207

(22)【出願日】2018-03-30

(65)【公開番号】P2019178598

(43)【公開日】2019-10-17

【審査請求日】2021-02-02

(73)【特許権者】

【識別番号】000001236

【氏名又は名称】株式会社小松製作所

(74)【代理人】

【識別番号】110002147

【氏名又は名称】弁理士法人酒井国際特許事務所

(72)【発明者】

【氏名】関 洋平

(72)【発明者】

【氏名】尾崎 将崇

(72)【発明者】

【氏名】今西 康太

(72)【発明者】

【氏名】青島 幸司

【審査官】柿原 巧弥

(56)【参考文献】

【文献】特開平１０－０８８６２５（ＪＰ，Ａ）

【文献】特開２０１７－０４３８８５（ＪＰ，Ａ）

【文献】特開２０００－１３６５４９（ＪＰ，Ａ）

【文献】特開平０５－２９７９４２（ＪＰ，Ａ）

【文献】国際公開第２０１６／１５２９９４（ＷＯ，Ａ１）

(58)【調査した分野】(Int.Cl.，ＤＢ名)

Ｅ０２Ｆ ９／２０

(57)【特許請求の範囲】

【請求項1】

作業機を有する作業機械に搭載され掘削対象及び積込対象を含む作業対象を計測する計測装置の計測データを取得する計測データ取得部と、
前記掘削対象の計測データを処理するための第１アルゴリズムと、前記積込対象の計測データを処理するための第２アルゴリズムとを記憶する記憶部と、
前記作業機械の作業モードが、前記作業機のバケットに掘削物が保持されていない状態で、前記作業機械が前記バケットで前記掘削対象を掘削するために前記掘削対象に向かって前進している掘削作業モードであると判定したときに、前記記憶部に記憶されている第１アルゴリズムを選択し、前記バケットに掘削物が保持されている状態で、前記作業機械が前記バケットにより掘削された掘削物を積み込むために前記積込対象に向かって前進している積込作業モードであると判定したときに、前記記憶部に記憶されている第２アルゴリズムを選択するアルゴリズム選択部と、
前記掘削作業モードにおいて、前記第１アルゴリズムに基づいて前記掘削対象の計測データを処理して、前記作業機械から前記掘削対象までの距離を算出し、前記積込作業モードにおいて、前記第２アルゴリズムに基づいて前記積込対象の計測データを処理して、前記作業機械から前記積込対象までの距離を算出する算出部と、を備える
作業機械の制御装置。

【請求項2】

前記算出部により算出された前記作業対象までの距離に基づいて、前記作業機を制御する作業機制御部を備える、
請求項１に記載の作業機械の制御装置。

【請求項3】

前記バケットが前記掘削対象の掘削物を保持しているか否かを判定する掘削物判定部と、
前記作業機械が前進しているか否かを判定する前後進判定部と、を備え、
前記アルゴリズム選択部は、前記掘削物判定部の判定データ及び前記前後進判定部の判定データに基づいて、前記記憶部に記憶されている第１アルゴリズム又は第２アルゴリズムを選択する、
請求項１又は請求項２に記載の作業機械の制御装置。

【請求項4】

掘削対象及び積込対象を含む作業機械の作業対象を計測する計測装置の計測データを取得することと、
前記掘削対象の計測データを処理するための第１アルゴリズムと、前記積込対象の計測データを処理するための第２アルゴリズムとを記憶部に記憶することと、
前記作業機械の作業モードが、前記作業機械の作業機のバケットに掘削物が保持されていない状態で、前記作業機械が前記バケットで前記掘削対象を掘削するために前記掘削対象に向かって前進している掘削作業モードであると判定したときに、前記記憶部に記憶されている第１アルゴリズムを選択し、前記バケットに掘削物が保持されている状態で、前記作業機械が前記バケットにより掘削された掘削物を積み込むために前記積込対象に向かって前進している積込作業モードであると判定したときに、前記記憶部に記憶されている第２アルゴリズムを選択することと、
前記掘削作業モードにおいて、前記第１アルゴリズムに基づいて前記掘削対象の計測データを処理して、前記作業機械から前記掘削対象までの距離を算出し、前記積込作業モードにおいて、前記第２アルゴリズムに基づいて前記積込対象の計測データを処理して、前記作業機械から前記積込対象までの距離を算出することと、を含む
作業機械の制御方法。

【請求項5】

前記バケットが前記掘削対象の掘削物を保持しているか否かを判定することと、
前記作業機械が前進しているか否かを判定することと、
前記掘削対象の掘削物を保持しているか否かの判定及び前記作業機械が前進しているか否かの判定に基づいて、前記記憶部に記憶されている第１アルゴリズム又は第２アルゴリズムを選択することと、を含む、
請求項４に記載の作業機械の制御方法。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、作業機械の制御装置及び作業機械の制御方法に関する。

【背景技術】

【0002】

作業現場において作業機械が使用される。掘削対象及び積込対象までの距離を求めるための計測器を備える自動掘削機の一例が特許文献１に開示されている。

【先行技術文献】

【特許文献】

【0003】

【文献】特開平１０－０８８６２５号公報

【発明の概要】

【発明が解決しようとする課題】

【0004】

作業機械による作業の自動化を実現する場合、作業対象に関するパラメータを取得することが要望される。

【0005】

本発明の態様は、作業対象に関するパラメータを取得することを目的とする。

【課題を解決するための手段】

【0006】

本発明の態様に従えば、作業機を有する作業機械に搭載され作業対象を計測する計測装置の計測データを取得する計測データ取得部と、前記作業機械の作業に応じて前記計測データを処理する特定のアルゴリズムを選択するアルゴリズム選択部と、前記アルゴリズム選択部により選択された前記アルゴリズムに基づいて前記計測データを処理して、前記作業対象に関するパラメータを算出する算出部と、を備える作業機械の制御装置が提供される。

【発明の効果】

【0007】

本発明の態様によれば、作業対象に関するパラメータを取得することができる。

【図面の簡単な説明】

【0008】

【図1】図１は、本実施形態に係る作業機械を示す側面図である。

【図2】図２は、本実施形態に係る作業機械の動作を示す模式図である。

【図3】図３は、本実施形態に係る作業機械の掘削作業モードを示す模式図である。

【図4】図４は、本実施形態に係る作業機械の積込作業モードを示す模式図である。

【図5】図５は、本実施形態に係る作業機械の制御装置を示す機能ブロック図である。

【図6】図６は、本実施形態に係る作業機械の制御方法を示すフローチャートである。

【図7】図７は、本実施形態に係る作業機械の制御方法を示すフローチャートである。

【図8】図８は、本実施形態に係る作業機械の制御方法を示す模式図である。

【図9】図９は、本実施形態に係る作業機械の制御方法を示すフローチャートである。

【図10】図１０は、本実施形態に係る作業機械の制御方法を示す模式図である。

【図11】図１１は、本実施形態に係る作業機械の制御方法を示す模式図である。

【図12】図１２は、コンピュータシステムの一例を示すブロック図である。

【発明を実施するための形態】

【0009】

以下、本発明に係る実施形態について図面を参照しながら説明するが、本発明はこれに限定されない。以下で説明する実施形態の構成要素は、適宜組み合わせることができる。また、一部の構成要素を用いない場合もある。

【0010】

［ホイールローダ］
図１は、本実施形態に係る作業機械１の一例を示す側面図である。作業機械１は、作業現場において作業対象に対して所定の作業を実施する。本実施形態においては、作業機械１がアーティキュレート作業機械の一種であるホイールローダ１であることとする。所定の作業は、掘削作業及び積込作業を含む。作業対象は、掘削対象及び積込対象を含む。ホイールローダ１は、掘削対象を掘削する掘削作業、及び掘削作業により掘削した掘削物を積込対象に積み込む積込作業を実施する。積込作業は、掘削物を排出対象に排出する排出作業を含む概念である。掘削対象として、地山、岩山、石炭、及び壁面の少なくとも一つが例示される。地山は、土砂により構成される山であり、岩山は、岩又は石により構成される山である。積込対象として、運搬車両、作業現場の所定エリア、ホッパ、ベルトコンベヤ、及びクラッシャの少なくとも一つが例示される。

【0011】

図１に示すように、ホイールローダ１は、車体２と、運転席が設けられる運転台３と、車体２を支持する走行装置４と、車体２に支持される作業機１０と、トランスミッション装置３０と、車体２よりも前方の作業対象を計測する三次元計測装置２０と、制御装置８０とを備える。

【0012】

車体２は、車体前部２Ｆと車体後部２Ｒとを含む。車体前部２Ｆと車体後部２Ｒとは、関節機構９を介して屈曲可能に連結される。

【0013】

運転台３は、車体２に支持される。ホイールローダ１の少なくとも一部は、運転台３に搭乗した運転者によって操作される。

【0014】

走行装置４は、車体２を支持する。走行装置４は、車輪５を有する。車輪５は、車体２に搭載されているエンジンが発生する駆動力により回転する。タイヤ６が車輪５に装着される。車輪５は、車体前部２Ｆに装着される２つの前輪５Ｆと、車体後部２Ｒに装着される２つの後輪５Ｒとを含む。タイヤ６は、前輪５Ｆに装着される前タイヤ６Ｆと、後輪５Ｒに装着される後タイヤ６Ｒとを含む。走行装置４は、地面ＲＳを走行可能である。

【0015】

以下の説明においては、前輪５Ｆの回転軸と平行な方向を適宜、車幅方向、と称し、地面ＲＳと接触する前タイヤ６Ｆの接地面と直交する方向を適宜、上下方向、と称し、車幅方向及び上下方向の両方と直交する方向を適宜、前後方向、と称する。ホイールローダ１の車体２が直進状態で走行するとき、前輪５Ｆの回転軸と後輪５Ｒの回転軸とは平行である。

【0016】

また、以下の説明においては、車幅方向において車体２の中心に近い位置又は方向を適宜、車幅方向の内側又は内方、と称し、車体２の中心から遠い位置又は方向を適宜、車幅方向の外側又は外方、と称する。また、車幅方向において、運転台３の運転席を基準とする一方を適宜、右側又は右方、と称し、右側又は右方の逆側又は逆方向を適宜、左側又は左方、と称する。また、前後方向において、運転台３の運転席を基準として作業機１０に近い位置又は方向を適宜、前側又は前方、と称し、前側又は前方の逆側又は逆方向を適宜、後側又は後方、と称する。また、上下方向において前タイヤ６Ｆの接地面に近い位置又は方向を適宜、下側又は下方、と称し、下側又は下方の逆側又は逆方向を適宜、上側又は上方、と称する。

【0017】

車体前部２Ｆは、車体後部２Ｒよりも前方に配置される。前輪５Ｆ及び前タイヤ６Ｆは、後輪５Ｒ及び後タイヤ６Ｒよりも前方に配置される。前輪５Ｆ及び前タイヤ６Ｆは、車体２の車幅方向の両側に配置される。後輪５Ｒ及び後タイヤ６Ｒは、車体２の車幅方向の両側に配置される。車体前部２Ｆは、車体後部２Ｒに対して左右に屈曲する。

【0018】

走行装置４は、駆動装置４Ａと、ブレーキ装置４Ｂと、操舵装置４Ｃとを有する。駆動装置４Ａは、ホイールローダ１を加速させるための駆動力を発生する。駆動装置４Ａは、ディーゼルエンジンのような内燃機関を含む。駆動装置４Ａで発生した駆動力がトランスミッション装置３０を介して車輪５に伝達され、車輪５が回転する。ブレーキ装置４Ｂは、ホイールローダ１を減速又は停止させるための制動力を発生する。操舵装置４Ｃは、ホイールローダ１の走行方向を調整可能である。ホイールローダ１の走行方向は、車体前部２Ｆの向きを含む。操舵装置４Ｃは、油圧シリンダによって車体前部２Ｆを屈曲させることによって、ホイールローダ１の走行方向を調整する。

【0019】

本実施形態において、走行装置４は、運転台３に搭乗した運転者によって操作される。作業機１０は、制御装置８０に制御される。走行装置４を操作する走行操作装置４０が運転台３に配置される。運転者は、走行操作装置４０を操作して、走行装置４を作動させる。走行操作装置４０は、アクセルペダル、ブレーキペダル、ステアリングレバー、及び前後進を切り換えるためのシフトレバー４１を含む。アクセルペダルが操作されることにより、ホイールローダ１の走行速度が増大する。ブレーキペダルが操作されることにより、ホイールローダ１の走行速度が減少したり走行が停止したりする。ステアリングレバーが操作されることにより、ホイールローダ１が旋回する。シフトレバー４１が操作されることにより、ホイールローダ１の前進又は後進が切り換えられる。

【0020】

トランスミッション装置３０は、駆動装置４Ａで発生した駆動力を車輪５に伝達する。

【0021】

作業機１０は、車体前部２Ｆに回動可能に連結されるブーム１１と、ブーム１１に回動可能に連結されるバケット１２と、ベルクランク１５と、リンク１６とを有する。

【0022】

ブーム１１は、ブームシリンダ１３が発生する動力によって作動する。ブームシリンダ１３が伸縮することにより、ブーム１１は上げ動作又は下げ動作する。

【0023】

バケット１２は、刃先を含む先端部１２Ｂを有する作業部材である。バケット１２は、前輪５Ｆよりも前方に配置される。バケット１２は、ブーム１１の先端部に連結される。バケット１２は、バケットシリンダ１４が発生する動力によって作動する。バケットシリンダ１４が伸縮することにより、バケット１２はダンプ動作又はチルト動作する。

【0024】

バケット１２のダンプ動作が実施されることにより、バケット１２ですくい上げられた掘削物がバケット１２から排出される。バケット１２のチルト動作が実施されることにより、バケット１２は掘削物をすくい取る。

【0025】

［三次元計測装置］
三次元計測装置２０は、ホイールローダ１に搭載される。三次元計測装置２０は、車体前部２Ｆよりも前方の作業対象を計測する。作業対象は、作業機１０による掘削対象、及び作業機１０により掘削された掘削物が積み込まれる積込対象を含む。三次元計測装置２０は、三次元計測装置２０から作業対象の表面の複数の各計測点までの相対位置を計測して、作業対象の三次元形状を計測する。制御装置８０は、計測された作業対象の三次元形状に基づいて、作業対象に関するパラメータを算出する。後述するように、作業対象に関するパラメータは、掘削対象までの距離、積込対象までの距離、掘削対象の安息角、及び積込対象の高さの少なくとも一つを含む。

【0026】

三次元計測装置２０は、レーザ計測装置の一種であるレーザレーダ２１と、写真計測装置の一種であるステレオカメラ２２とを含む。

【0027】

［動作］
図２は、本実施形態に係るホイールローダ１の動作を示す模式図である。ホイールローダ１は、複数の作業モードで作業する。作業モードは、作業機１０のバケット１２で掘削対象を掘削する掘削作業モードと、掘削作業モードによりバケット１２ですくい取った掘削物を積込対象に積み込む積込作業モードとを含む。掘削対象として、地面ＲＳに置かれた地山ＤＳが例示される。積込対象として、地面を走行可能な運搬車両ＬＳのベッセルＢＥ（ダンプボディ）が例示される。運搬車両ＬＳとして、ダンプトラックが例示される。

【0028】

掘削作業モードにおいて、ホイールローダ１は、バケット１２に掘削物が保持されていない状態で、バケット１２で地山ＤＳを掘削するために地山ＤＳに向かって前進する。ホイールローダ１の運転者は、走行操作装置４０を操作して、図２の矢印Ｍ１で示すように、ホイールローダ１を前進させて地山ＤＳに接近させる。ホイールローダ１に搭載されている三次元計測装置２０は、地山ＤＳの三次元形状を計測する。制御装置８０は、三次元計測装置２０の計測データに基づいて、地山ＤＳに関するパラメータとして、ホイールローダ１から地山ＤＳまでの距離を算出し、バケット１２で地山ＤＳが掘削されるように、作業機１０を制御する。すなわち、制御装置８０は、ホイールローダ１が地山ＤＳに接近するように前進している状態で、バケット１２の先端部１２Ｂ及び底面部が地面ＲＳに接触するように、作業機１０を制御する。

【0029】

バケット１２が地山ＤＳに突入して地山ＤＳがバケット１２により掘削され、掘削物がバケット１２にすくい取られた後、ホイールローダ１は、バケット１２に掘削物が保持されている状態で、地山ＤＳから離れるように後進する。ホイールローダ１の運転者は、走行操作装置４０を操作して、図２の矢印Ｍ２で示すように、ホイールローダ１を後進させて地山ＤＳから離間させる。

【0030】

次に、積込作業モードが実施される。積込作業モードにおいて、ホイールローダ１は、バケット１２に掘削物が保持されている状態で、バケット１２により掘削された掘削物を積み込むために運搬車両ＬＳに向かって前進する。ホイールローダ１の運転者は、走行操作装置４０を操作して、図２の矢印Ｍ３で示すように、ホイールローダ１を旋回させながら前進させて運搬車両ＬＳに接近させる。ホイールローダ１に搭載されている三次元計測装置２０は、運搬車両ＬＳの三次元形状を計測する。制御装置８０は、三次元計測装置２０の計測データに基づいて、運搬車両ＬＳに関するパラメータとして、ホイールローダ１から運搬車両ＬＳまでの距離を算出し、バケット１２に保持されている掘削物が運搬車両ＬＳのベッセルＢＥに積み込まれるように、作業機１０を制御する。すなわち、制御装置８０は、ホイールローダ１が運搬車両ＬＳに接近するように前進している状態で、ブーム１１が上げ動作するように、作業機１０を制御する。ブーム１１が上げ動作し、バケット１２がベッセルＢＥの上方に配置された後、制御装置８０は、バケット１２がチルト動作するように、作業機１０を制御する。これにより、バケット１２から掘削物が排出され、ベッセルＢＥに積み込まれる。

【0031】

バケット１２から掘削物が排出され、ベッセルＢＥに積み込まれた後、ホイールローダ１は、バケット１２に掘削物が保持されていない状態で、運搬車両ＬＳから離れるように後進する。運転者は、走行操作装置４０を操作して、図２の矢印Ｍ４で示すように、ホイールローダ１を後進させて運搬車両ＬＳから離間させる。

【0032】

運転者及び制御装置８０は、ベッセルＢＥに掘削物が満載されるまで、上述の動作を繰り返す。

【0033】

図３は、本実施形態に係るホイールローダ１の掘削作業モードを示す模式図である。ホイールローダ１の運転者は、走行操作装置４０を操作して、ホイールローダ１を前進させて地山ＤＳに接近させる。

【0034】

図３（Ａ）に示すように、ホイールローダ１に搭載されている三次元計測装置２０は、地山ＤＳの三次元形状を計測する。制御装置８０は、三次元計測装置２０の計測データに基づいて、地面ＲＳと地山ＤＳとの境界ＤＰの位置を特定する。

【0035】

図３（Ｂ）に示すように、制御装置８０は、ホイールローダ１が地山ＤＳに接近するように前進している状態で、三次元計測装置２０の計測データに基づいて、地山ＤＳに関するパラメータとして、バケット１２の先端部１２Ｂと境界ＤＰとの距離を算出する。制御装置８０は、三次元計測装置２０の計測データに基づいて、バケット１２の先端部１２Ｂが境界ＤＰに接近するように、ブーム１１を下げ動作させるとともに、バケット１２の角度を制御する。

【0036】

図３（Ｃ）に示すように、ホイールローダ１がさらに前進することにより、バケット１２の先端部１２Ｂが境界ＤＰから地山ＤＳに挿入される。これにより、地山ＤＳがバケット１２により掘削され、バケット１２は、掘削物をすくい取ることができる。

【0037】

図４は、本実施形態に係るホイールローダ１の積込作業モードを示す模式図である。ホイールローダ１の運転者は、走行操作装置を操作して、ホイールローダ１を前進させて運搬車両ＬＳに接近させる。図４（Ａ）に示すように、ホイールローダ１に搭載されている三次元計測装置２０は、運搬車両ＬＳの手前側表面の三次元形状を計測する。制御装置８０は、三次元計測装置２０の計測データに基づいて、地山ＤＳに関するパラメータとして、バケット１２の先端部１２Ｂと運搬車両ＬＳとの距離及びベッセルＢＥの上端部の高さを検出する。ベッセルＢＥの上端部の高さは、例えば後述する図１０のようにベッセルＢＥを側面視した際の側壁面におけるおよそ水平な上端部の地面ＲＳからの距離である。

【0038】

図４（Ｂ）に示すように、制御装置８０は、ホイールローダ１が運搬車両ＬＳに接近するように前進している状態で、三次元計測装置２０の計測データに基づいて、バケット１２がベッセルＢＥの上端部よりも上方に配置されるように、且つ、バケット１２に保持されている掘削物がバケット１２からこぼれないように、バケット１２の角度を制御しながら、ブーム１１を上げ動作させる。

【0039】

図４（Ｃ）に示すように、ブーム１１が上げ動作し、バケット１２がベッセルＢＥの上方に配置された後、制御装置８０は、バケット１２がチルト動作するように、作業機１０を制御する。これにより、バケット１２から掘削物が排出され、ベッセルＢＥに積み込まれる。

【0040】

［制御装置］
図５は、本実施形態に係るホイールローダ１の制御装置８０を示す機能ブロック図である。制御装置８０は、コンピュータシステムを含む。

【0041】

制御装置８０に、作業機１０、三次元計測装置２０、掘削物判定用センサ５１、回転センサ５２、及び走行操作装置４０が接続される。

【0042】

制御装置８０は、計測データ取得部８１と、記憶部８２と、掘削物判定部８３と、前後進判定部８４と、アルゴリズム選択部８５と、算出部８６と、作業機制御部８７とを有する。

【0043】

計測データ取得部８１は、三次元計測装置２０の計測データを取得する。

【0044】

記憶部８２は、計測データ取得部８１により取得された計測データを処理する複数のアルゴリズムを記憶する。アルゴリズムとは、計測データ取得部８１により取得された計測データを用いて、所定のデータを出力するための手順、フローチャート、手法、又はプログラムをいう。複数のアルゴリズムに応じて、手順、手法、又はプログラムを異ならせてもよいし、出力されるデータの数又は種類を異ならせてもよい。記憶部８２には、ステレオカメラ２２で計測された地山ＤＳの計測データを処理するための第１アルゴリズムと、ステレオカメラ２２で計測された運搬車両ＬＳの計測データを処理するための第２アルゴリズムとが記憶されている。また、記憶部８２には、レーザレーダ２１で計測された地山ＤＳの計測データを処理するためのアルゴリズムと、レーザレーダ２１で計測された運搬車両ＬＳの計測データを処理するためのアルゴリズムとが記憶されている。レーザレーダ２１で計測された地山ＤＳの計測データを処理するためのアルゴリズムは、第１アルゴリズムの一例であり、レーザレーダ２１で計測された運搬車両ＬＳの計測データを処理するためのアルゴリズムは、第２アルゴリズムの一例である。

【0045】

掘削物判定部８３は、バケット１２が掘削物を保持しているか否かを判定する。掘削物判定用センサ５１は、検出データを制御装置８０に出力する。掘削物判定用センサ５１は、重量センサ、ブームシリンダ圧力センサ、ブーム角度センサ、及びバケット角度センサの少なくとも一つを含む。重量センサは、バケット１２の重量、バケット１２における掘削物の有無、及びバケット１２に保持された掘削物の重量の少なくとも一つを検出することができる。ブームシリンダ圧力センサは、ブームシリンダ１３の内部空間の作動油の圧力を検出することができる。ブーム角度センサは、車体座標系におけるブーム１１の回動角度を検出することができる。バケット角度センサは、車体座標系におけるバケット１２の回動角度を検出することができる。掘削物判定部８３は、掘削物判定用センサ５１の検出データに基づいて、バケット１２が掘削物を保持しているか否かを判定する。掘削物判定部８３は、重量センサ、ブームシリンダ圧力センサ、ブーム角度センサ、及びバケット角度センサの少なくとも一つの検出信号に基づいて、バケット１２が掘削物を保持しているか否かを判定することができる。

【0046】

前後進判定部８４は、回転センサ５２の検出データに基づいて、ホイールローダ１が前進しているか否かを判定する。回転センサ５２は、車輪５の回転速度及び回転方向を検出する。なお、前後進判定部８４は、走行操作装置４０のシフトレバー４１の操作信号に基づいて、ホイールローダ１が前進しているか否かを判定してもよい。

【0047】

アルゴリズム選択部８５は、ホイールローダ１の作業に応じて、記憶部８２に記憶されている複数のアルゴリズムから、計測データ取得部８１により取得された計測データを処理する特定のアルゴリズムを選択する。ホイールローダ１の作業は、ホイールローダ１の作業モード、及びホイールローダ１の作業対象の少なくとも一方を含む。

【0048】

本実施形態において、アルゴリズム選択部８５は、掘削物判定部８３の判定データ及び前後進判定部８４の判定データに基づいて、ホイールローダ１の作業モードを判定し、ホイールローダ１の作業モードに応じて、記憶部８２に記憶されている複数のアルゴリズムから、計測データ取得部８１により取得された計測データを処理する特定のアルゴリズムを選択する。

【0049】

掘削作業モードにおいて、ホイールローダ１は、バケット１２に掘削物が保持されていない状態で、地山ＤＳに向かって前進する。積込作業モードにおいて、ホイールローダ１は、バケット１２に掘削物が保持されている状態で、運搬車両ＬＳに向かって前進する。アルゴリズム選択部８５は、掘削物判定部８３の判定データ及び前後進判定部８４の判定データに基づいて、ホイールローダ１がバケット１２で地山ＤＳを掘削するために地山ＤＳに向かって前進していると判定したときに、記憶部８２に記憶されている複数のアルゴリズムから第１アルゴリズムを選択する。また、アルゴリズム選択部８５は、ホイールローダ１がバケット１２により掘削された掘削物を積み込むために運搬車両ＬＳに向かって前進していると判定したときに、記憶部８２に記憶されている複数のアルゴリズムから第２アルゴリズムを選択する。

【0050】

なお、アルゴリズム選択部８５は、ホイールローダ１の作業モードを判定することなく、掘削物判定部８３の判定データ及び前後進判定部８４の判定データに基づいて、複数のアルゴリズムから特定のアルゴリズムを選択してもよい。アルゴリズム選択部８５は、少なくとも掘削物判定部８３の判定データに基づいて、作業モードを判定又は特定のアルゴリズムを選択してもよい。

【0051】

算出部８６は、アルゴリズム選択部８５により選択されたアルゴリズムに基づいて計測データを処理して、作業対象に関するパラメータを算出する。算出部８６は、地山ＤＳに関するパラメータを算出するための第１アルゴリズムが選択されたとき、地山ＤＳに関するパラメータとして、ホイールローダ１から地山ＤＳまでの距離を算出する。算出部８６は、アルゴリズム選択部８５により選択された第１アルゴリズムに基づいて計測データ取得部８１により取得された計測データを処理して、ホイールローダ１から地山ＤＳまでの距離を算出する。また、算出部８６は、運搬車両ＬＳに関するパラメータを算出するための第２アルゴリズムが選択されたとき、運搬車両ＬＳに関するパラメータとして、ホイールローダ１から運搬車両ＬＳまでの距離を算出する。算出部８６は、アルゴリズム選択部８５により選択された第２アルゴリズムに基づいて計測データ取得部８１により取得された計測データを処理して、ホイールローダ１から運搬車両ＬＳまでの距離を算出する。

【0052】

なお、算出部８６は、ホイールローダ１から地山ＤＳまでの距離に加え、地山ＤＳに関するパラメータとして、地山ＤＳの安息角を算出してもよい。本実施形態において、地山ＤＳに関するパラメータは、ホイールローダ１から地山ＤＳまでの距離、地山ＤＳの安息角、地山ＤＳの岩土の質、地山ＤＳを構成する岩土の粒度、地山ＤＳの高さ、地山ＤＳの形状、及び地山ＤＳの体積の少なくとも一つを含む。

【0053】

なお、算出部８６は、ホイールローダ１から運搬車両ＬＳまでの距離に加え、運搬車両ＬＳに関するパラメータとして、運搬車両ＬＳのベッセルＢＥの高さを算出してもよい。本実施形態において、運搬車両ＬＳに関するパラメータは、ホイールローダ１から運搬車両ＬＳまでの距離、運搬車両ＬＳのベッセルＢＥの高さ、運搬車両ＬＳの全長、ベッセルＢＥの投入口の全長、及びベッセルＢＥの上端部から飛び出している岩土の高さの少なくとも一つを含む。

【0054】

ホイールローダ１の作業モードが掘削作業モードであると判定され、アルゴリズム選択部８５により第１アルゴリズムが選択された場合、算出部８６は、第１アルゴリズムに基づいて地山ＤＳの計測データを処理して、ホイールローダ１から地山ＤＳまでの距離を算出する。ホイールローダ１の作業モードが積込作業モードであると判定され、アルゴリズム選択部８５により第２アルゴリズムが選択された場合、算出部８６は、第２アルゴリズムに基づいて運搬車両ＬＳの計測データを処理して、ホイールローダ１から運搬車両ＬＳまでの距離を算出する。

【0055】

ホイールローダ１から地山ＤＳまでの距離は、ホイールローダ１から地山ＤＳと地面ＲＳとの境界ＤＰまでの距離、およびホイールローダ１のバケット１２の先端部１２Ｂから地山ＤＳと地面ＲＳとの境界ＤＰまでの距離を含む。ホイールローダ１から運搬車両ＬＳまでの距離は、ホイールローダ１からベッセルＢＳまでの距離、およびホイールローダ１から運搬車両ＬＳまでの距離は、ホイールローダ１のバケット１２の先端部１２ＢからベッセルＢＳの手前側表面までの距離を含む。

【0056】

作業機制御部８７は、算出部８６により算出された作業対象までの距離に基づいて、作業機１０の動作を制御する。作業機制御部８７は、算出部８６により算出された地山ＤＳの安息角、又はベッセルＢＥの高さに基づいて、作業機１０の動作を制御してもよい。作業機１０の動作の制御は、ブームシリンダ１３及びバケットシリンダ１４の少なくとも一方の動作の制御を含む。ホイールローダ１は、図示しない油圧ポンプと、油圧ポンプからブームシリンダ１３に供給される作動油の流量及び方向を制御する図示しないブーム制御弁と、油圧ポンプからバケットシリンダ１４に供給される作動油の流量及び方向を制御する図示しないバケット制御弁とを有する。作業機制御部８７は、ブーム制御弁に制御信号を出力して、ブームシリンダ１３に供給される作動油の流量及び方向を制御することによって、ブーム１１の上げ動作、下げ動作、上げ動作の動作速度、及び下げ動作の動作速度を制御することができる。また、作業機制御部８７は、バケット制御弁に制御信号を出力して、バケットシリンダ１４に供給される作動油の流量及び方向を制御することによって、バケット１２のダンプ動作、チルト動作、ダンプ動作の動作速度、及びチルト動作の動作速度を制御することができる。

【0057】

本実施形態において、ホイールローダ１は、トランスミッション制御部８８と、走行制御部８９とを有する。

【0058】

トランスミッション制御部８８は、ホイールローダ１の運転者による走行操作装置４０の操作に基づいて、トランスミッション装置３０の動作を制御する。トランスミッション装置３０の動作の制御は、シフトチェンジの制御を含む。

【0059】

走行制御部８９は、ホイールローダ１の運転者による走行操作装置４０の操作に基づいて、走行装置４の動作を制御する。走行制御部８９は、駆動装置４Ａを作動するためのアクセル指令、ブレーキ装置４Ｂを作動するためのブレーキ指令、及び操舵装置４Ｃを作動するためのステアリング指令を含む運転指令を出力する。

【0060】

［作業モードの切換］
図６は、本実施形態に係るホイールローダ１の制御方法を示すフローチャートであって、作業モードの切換方法を示す。なお、図６は、三次元計測装置２０としてステレオカメラ２２が用いられる処理を示す。

【0061】

図２、図３、及び図４を参照して説明したように、掘削作業モードにおいて、ホイールローダ１は、バケット１２に掘削物が保持されていない状態で、図２の矢印Ｍ１で示したように、バケット１２で地山ＤＳを掘削するために地山ＤＳに向かって前進する。

【0062】

掘削物判定部８３は、掘削物判定用センサ５１の検出データに基づいて、バケット１２が掘削物を保持していないと判定することができる。前後進判定部８４は、回転センサ５２の検出データに基づいて、ホイールローダ１が前進していると判定することができる。アルゴリズム選択部８５は、掘削物判定部８３の判定データ及び前後進判定部８４の判定データに基づいて、バケット１２に掘削物が保持されていない状態で、ホイールローダ１がバケット１２で地山ＤＳを掘削するために地山ＤＳに向かって前進していると判定することができる（ステップＳ１）。

【0063】

アルゴリズム選択部８５は、ホイールローダ１が作業機１０で地山ＤＳを掘削するために地山ＤＳに向かって前進していると判定したときに、記憶部８２に記憶されている複数のアルゴリズムから第１アルゴリズムを選択する（ステップＳ２）。

【0064】

算出部８６は、アルゴリズム選択部８５により選択された第１アルゴリズムに基づいて、ステレオカメラ２２により計測された地山ＤＳの計測データを処理して、ホイールローダ１から地山ＤＳまでの距離を算出する。

【0065】

地山ＤＳがバケット１２により掘削され、掘削物がバケット１２に保持された後、ホイールローダ１は、バケット１２に掘削物が保持されている状態で、図２の矢印Ｍ２で示したように、地山ＤＳから離れるように後進する。

【0066】

次に、積込作業モードが実施される。積込作業モードにおいて、ホイールローダ１は、バケット１２に掘削物が保持されている状態で、図２の矢印Ｍ３で示したように、バケット１２により掘削された掘削物を積み込むために運搬車両ＬＳに向かって前進する。

【0067】

掘削物判定部８３は、掘削物判定用センサ５１の検出データに基づいて、バケット１２が掘削物を保持していると判定することができる。前後進判定部８４は、回転センサ５２の検出データに基づいて、ホイールローダ１が前進していると判定することができる。アルゴリズム選択部８５は、掘削物判定部８３の判定データ及び前後進判定部８４の判定データに基づいて、バケット１２に掘削物が保持されている状態で、ホイールローダ１がバケット１２により掘削された掘削物を積み込むために運搬車両ＬＳのベッセルＢＥに向かって前進していると判定することができる（ステップＳ３）。

【0068】

アルゴリズム選択部８５は、ホイールローダ１が作業機１０により掘削された掘削物を積み込むために運搬車両ＬＳのベッセルＢＥに向かって前進していると判定したときに、記憶部８２に記憶されている複数のアルゴリズムから第２アルゴリズムを選択する（ステップＳ４）。

【0069】

算出部８６は、アルゴリズム選択部８５により選択された第２アルゴリズムに基づいて、三次元計測装置２０により計測された運搬車両ＬＳの計測データを処理して、ホイールローダ１から運搬車両ＬＳまでの距離を算出する。

【0070】

バケット１２から掘削物が排出され、ベッセルＢＥに積み込まれた後、ホイールローダ１は、バケット１２に掘削物が保持されていない状態で、図２の矢印Ｍ４で示したように、運搬車両ＬＳから離れるように後進する。

【0071】

なお、三次元計測装置２０としてレーザレーダ２１が用いられる場合、ステップＳ２においてはレーザレーダ２１を用いた場合における第１アルゴリズムが選択され、ステップＳ５においてはレーザレーダ２１を用いた場合における第２アルゴリズムが選択される。

【0072】

［第１アルゴリズムによる処理］
図７は、本実施形態に係るホイールローダ１の制御方法を示すフローチャートであって、ステレオカメラ２２による地山ＤＳの計測データを第１アルゴリズムに基づいて処理する方法を示す。図７に示す処理は、図６を参照して説明したステップＳ２のサブルーチンに相当する。

【0073】

ホイールローダ１が作業機１０で地山ＤＳを掘削するために地山ＤＳに向かって前進する掘削作業モードにおいて、ステレオカメラ２２は、地山ＤＳを計測する。計測データ取得部８１は、ステレオカメラ２２から、地山ＤＳを計測したステレオカメラ２２の計測データを取得する（ステップＳ２０１）。

【0074】

図８は、本実施形態に係るホイールローダ１の制御方法を示す模式図であって、ステレオカメラ２２による計測方法を模式的に示す。図８に示すように、ステレオカメラ２２は、地山ＤＳの表面の複数の計測点ＰＩのそれぞれとの距離を計測する。

【0075】

地山ＤＳの斜面の位置は、ホイールローダ１の車体座標系において規定される。車体座標系におけるステレオカメラ２２の設置位置は、ホイールローダ１の設計データから導出される既知データである。算出部８６は、車体座標系におけるステレオカメラ２２から地山ＤＳの斜面における複数の計測点ＰＩまでの距離を算出する。地山ＤＳの斜面の位置は、車体座標系におけるステレオカメラ２２から地山ＤＳの斜面までの距離によって規定される。算出部８６は、地山ＤＳの表面の複数の計測点ＰＩのそれぞれまでの距離に基づいて、地山ＤＳの三次元形状を算出する（ステップＳ２０２）。

【0076】

算出部８６は、第１アルゴリズムに基づいて、ホイールローダ１から地山ＤＳまでの距離を算出する。算出部８６は、複数の計測点ＰＩについて直線フィッティングを実施して、複数の計測点ＰＩに基づいて仮想的な直線ＩＬを算出する。直線ＩＬは、地山ＤＳの斜面の推定形状を示す。すなわち、算出部８６は、複数の計測点ＰＩについて直線フィッティングを実施して、地山ＤＳの斜面の位置を算出する（ステップＳ２０３）。

【0077】

算出部８６は、例えばタイヤ６の接地面に基づいて、地面ＲＳの位置を算出する（ステップＳ２０４）。車体座標系におけるタイヤ６の接地面の位置は、ホイールローダ１の設計データから導出される既知データである。４つのタイヤ６のうち少なくとも３つのタイヤ６の接地面によって、車体座標系における地面ＲＳの位置が特定される。

【0078】

なお、算出部８６は、慣性計測装置（ＩＭＵ：Inertial Measurement Unit）又は傾斜センサの検出データに基づいて、地面ＲＳの位置を特定してもよい。また、ステレオカメラ２２による計測範囲に地面ＲＳが配置される場合、ステレオカメラ２２の計測データに基づいて、地面ＲＳの位置が算出されてもよい。また、ステレオカメラ２２による計測範囲に地面ＲＳが配置される場合において、タイヤ６の接地面に基づいて地面ＲＳの位置を特定する場合、地面ＲＳにおけるステレオカメラ２２の計測点ＰＩの位置データが除去されてもよい。また、計測点ＰＩの位置データを除去する場合、高さ閾値が設定され、その高さ閾値に基づいて計測点ＰＩの位置データが除去されてもよい。

【0079】

地山ＤＳの斜面の位置と地面ＲＳの位置とが算出された後、算出部８６は、地山ＤＳの斜面と地面ＲＳとの境界ＤＰの位置を算出する（ステップＳ２０５）。

【0080】

算出部８６は、ステレオカメラ２２から境界ＤＰまでの距離又は作業機１０の先端部１２Ｂから境界ＤＰまでの距離を算出する（ステップＳ２０６）。算出部８６は、ステレオカメラ２２から境界ＤＰまでの距離に加え、車体座標系におけるステレオカメラ２２の設置位置、作業機１０の設置位置、作業機１０の寸法、及び作業機１０の角度等を用いて、作業機１０の先端部１２Ｂから境界ＤＰまでの距離を算出する。

【0081】

作業機制御部８７は、算出部８６により算出された境界ＤＰまでの距離に基づいて、作業機１０を制御する（ステップＳ２０７）。

【0082】

以上のように、本実施形態において、第１アルゴリズムによる処理は、ステレオカメラ２２の計測データから地山ＤＳの三次元形状を特定し、地山ＤＳの斜面を特定し、境界ＤＰの位置を特定し、ホイールローダ１から境界ＤＰまでの距離を算出することを含む。これにより、図３を参照して説明したように、作業機制御部８７は、ホイールローダ１が地山ＤＳに接近するように前進している状態で、算出部８６により算出された境界ＤＰまでの距離に基づいて、バケット１２の先端部１２Ｂが境界ＤＰに接近するように、ブーム１１を下げ動作させるとともに、バケット１２の角度を制御することができる。ホイールローダ１がさらに前進することにより、バケット１２の先端部１２Ｂが境界ＤＰから地山ＤＳに挿入される。これにより、地山ＤＳがバケット１２により掘削され、バケット１２は、掘削物をすくい取ることができる。

【0083】

［第２アルゴリズムによる処理］
図９は、本実施形態に係るホイールローダ１の制御方法を示すフローチャートであって、ステレオカメラ２２による運搬車両ＬＳの計測データを第２アルゴリズムに基づいて処理する方法を示す。図９に示す処理は、図６を参照して説明したステップＳ４のサブルーチンに相当する。

【0084】

ホイールローダ１が作業機１０による掘削された掘削物を積み込むために運搬車両ＬＳに向かって前進する積込作業モードにおいて、ステレオカメラ２２は、運搬車両ＬＳを計測する。計測データ取得部８１は、ステレオカメラ２２から、運搬車両ＬＳを計測したステレオカメラ２２の計測データを取得する（ステップＳ４０１）。

【0085】

ステレオカメラ２２は、運搬車両ＬＳの表面の複数の計測点ＰＩのそれぞれとの距離を計測する。

【0086】

図１０は、本実施形態に係るステレオカメラ２２により取得された運搬車両ＬＳを含む画像データの一例を示す図である。なお、図１０においては、計測点ＰＩ（点データ）を１つしか記載されていないが、図１０に示す画像データの画素ごとに計測点ＰＩが設定される。ステレオカメラ２２は、画像データに対してステレオ処理を行うことにより距離画像を得ることができる。

【0087】

算出部８６は、ステレオカメラ２２の計測データ（画像データ）に基づいて、車体座標系におけるステレオカメラ２２から各画素に写る運搬車両ＬＳの表面における複数の計測点ＰＩまでの距離を算出する。運搬車両ＬＳの表面の位置は、車体座標系におけるステレオカメラ２２から運搬車両ＬＳの表面までの距離によって規定される。算出部８６は、運搬車両ＬＳの表面の複数の計測点ＰＩのそれぞれまでの距離に基づいて、運搬車両ＬＳの三次元形状を算出する（ステップＳ４０２）。

【0088】

次に、算出部８６は、ステレオカメラ２２からの距離と、その距離を示す計測点ＰＩのデータ数との関係を示すヒストグラムを作成する（ステップＳ４０３）。

【0089】

図１１は、ステレオカメラ２２から計測点ＰＩまでの距離と、各距離に存在する計測点ＰＩのデータ数との関係を示すヒストグラムを示す模式図である。

【0090】

図１０に示す画像データにおいては、例えば地面のような運搬車両ＬＳ以外の計測対象が含まれているため、図１１に示すように、幅広い距離においてヒストグラムのデータが存在する。一方、図１０に示す画像データにおいては、運搬車両ＬＳの領域が占める割合が大きい。そのため、ヒストグラムにおいて、ステレオカメラ２２から運搬車両ＬＳの計測点ＰＩまでの距離においてピークが立つ。算出部８６は、ピークが立つ距離をステレオカメラ２２から運搬車両ＬＳまでの距離であると判定する。そして、算出部８６は、ヒストグラムに基づいて、ホイールローダ１から運搬車両ＬＳまでの距離を算出する（ステップＳ４０４）。

【0091】

作業機制御部８７は、算出部８６により算出された運搬車両ＬＳまでの距離に基づいて、作業機１０を制御する（ステップＳ４０５）。

【0092】

以上のように、本実施形態において、第１アルゴリズムによる処理は、ステレオカメラ２２の計測データから、ステレオカメラ２２からの距離と計測点ＰＩのデータ数との関係を示すヒストグラムを作成し、ヒストグラムにおいてピークが立つ距離を運搬車両ＬＳまでの距離であると特定し、ホイールローダ１から運搬車両ＬＳまでの距離を算出することを含む。これにより、図４を参照して説明したように、作業機制御部８７は、ホイールローダ１が運搬車両ＬＳに接近するように前進している状態で、算出部８６により算出された運搬車両ＬＳまでの距離に基づいて、バケット１２がベッセルＢＥの上端部よりも上方に配置されるように、且つ、バケット１２に保持されている掘削物がバケット１２からこぼれないように、バケット１２の角度を制御しながら、ブーム１１を上げ動作させることができる。ブーム１１が上げ動作し、バケット１２がベッセルＢＥの上方に配置された後、作業機制御部８７は、バケット１２がチルト動作するように、作業機１０を制御する。これにより、バケット１２から掘削物が排出され、ベッセルＢＥに積み込まれる。

【0093】

なお、本実施形態においては、三次元計測装置２０としてステレオカメラ２２が使用され、作業モードに応じて、第１アルゴリズムによる処理と第２アルゴリズムによる処理とが選択される例について説明した。三次元計測装置２０としてレーザレーダ２１が使用される場合も同様である。レーザレーダ２１を用いる場合、作業モードに応じて、レーザレーダ２１に適応する第１アルゴリズムによる処理とレーザレーダ２１に適応する第２アルゴリズムによる処理とが選択される。

【0094】

［効果］
以上説明したように、本実施形態においては、三次元計測装置２０の計測データを処理するアルゴリズムが、ホイールローダ１の作業モードに基づいて切り換えられる。これにより、作業モードに応じて作業対象が変化しても、作業対象に応じて適切なアルゴリズムが選択され、選択されたアルゴリズムに基づいてホイールローダ１から作業対象までの距離が算出される。

【0095】

作業現場においては、三次元計測装置２０の計測対象は、例えば地山ＤＳと運搬車両ＬＳといったように形状の差異が大きい場合がある。また、作業機１０の制御において必要な情報が作業対象によって異なる。例えば、作業対象が地山ＤＳである場合、作業機１０の制御において地山ＤＳの安息角又は境界ＤＰの位置が必要となる。作業対象が運搬車両ＬＳである場合、作業機１０の制御においてベッセルＢＥまでの距離及びベッセルＢＥの高さが必要となる。作業現場においては、三次元計測装置２０は、形状又は必要な情報が異なる作業対象を順次計測する。形状及び作業機１０の制御において必要な情報が異なる作業対象までの距離を高精度に算出するためには、作業対象に応じて異なるアルゴリズムを利用することが有効である。三次元計測装置２０の計測データを処理するアルゴリズムが１つである場合、作業機１０の制御において十分な精度で作業対象までの距離を算出することが困難となる可能性がある。

【0096】

本実施形態によれば、ホイールローダ１の作業モードが判定され、作業モードに応じて計測データを処理するアルゴリズムが選択される。そのため、作業対象が切り換わっても、その計測対象までの距離ＤＳを高精度に算出することができる。すなわち、アルゴリズム選択部８５によって異なるアルゴリズムが選択された場合、算出部８６は、異なる作業対象に関するパラメータを算出し出力することができる。

【0097】

本実施形態においては、図２を参照して説明したように、ホイールローダ１は、バケット１２に掘削物が保持されていない状態で前進する動作（矢印Ｍ１参照）、バケット１２に掘削物が保持されている状態で後進する動作（矢印Ｍ２参照）、バケット１２に掘削物が保持されている状態で前進する動作（矢印Ｍ３参照）、及びバケット１２に掘削物が保持されていない状態で後進する動作（矢印Ｍ４参照）を繰り返す。したがって、アルゴリズム選択部８５は、掘削物判定部８３の判定データ及び前後進判定部８４の判定データに基づいて、記憶部８２に記憶されている複数のアルゴリズムから、作業モードに応じた適切なアルゴリズムを選択することができる。

【0098】

本実施形態において、ホイールローダ１から地山ＤＳまでの距離は、ホイールローダ１から地山ＤＳと地面ＲＳとの境界ＤＰまでの距離を含む。これにより、図３を参照して説明したように、制御装置８０は、三次元計測装置２０の計測データに基づいて、バケット１２の先端部１２Ｂが境界ＤＰに接近するように、ブーム１１を下げ動作させるとともに、バケット１２の角度を制御することができる。

【0099】

本実施形態において、ホイールローダ１から運搬車両ＬＳまでの距離は、ホイールローダ１から運搬車両ＬＳの手前側表面までの距離を含む。これにより、図４を参照して説明したように、制御装置８０は、三次元計測装置２０の計測データに基づいて、バケット１２がベッセルＢＥの上端部よりも上方に配置されるように、且つ、バケット１２に保持されている掘削物がバケット１２からこぼれないように、バケット１２の角度を制御しながら、ブーム１１を上げ動作させることができる。また、制御装置８０は、ブーム１１が上げ動作し、バケット１２がベッセルＢＥの上方に配置された後、バケット１２がチルト動作するように、作業機１０を制御することができる。

【0100】

［コンピュータシステム］
図１２は、コンピュータシステム１０００の一例を示すブロック図である。上述の制御装置８０は、コンピュータシステム１０００を含む。コンピュータシステム１０００は、ＣＰＵ（Central Processing Unit）のようなプロセッサ１００１と、ＲＯＭ（Read Only Memory）のような不揮発性メモリ及びＲＡＭ（Random Access Memory）のような揮発性メモリを含むメインメモリ１００２と、ストレージ１００３と、入出力回路を含むインターフェース１００４とを有する。上述の制御装置８０の機能は、プログラムとしてストレージ１００３に記憶されている。プロセッサ１００１は、プログラムをストレージ１００３から読み出してメインメモリ１００２に展開し、プログラムに従って上述の処理を実行する。なお、プログラムは、ネットワークを介してコンピュータシステム１０００に配信されてもよい。

【0101】

制御装置８０を含むコンピュータシステム１０００は、ホイールローダ１に搭載され作業対象の三次元形状を計測する三次元計測装置２０の計測データを取得することと、ホイールローダ１の作業に応じて計測データを処理する特定のアルゴリズムを選択することと、選択されたアルゴリズムに基づいて計測データを処理して、作業対象に関するパラメータを算出することと、を実行することができる。

【0102】

［その他の実施形態］
なお、上述の実施形態においては、三次元計測装置２０としてレーザレーダ２１及びステレオカメラ２２の両方がホイールローダ１に設けられることとした。レーザレーダ２１及びステレオカメラ２２の一方がホイールローダ１に設けられてもよい。また、三次元計測装置２０は、作業対象の三次元形状及び作業対象との相対位置を計測できればよく、レーザレーダ２１及びステレオカメラ２２に限定されない。任意の三次元計測装置２０を使用した場合においても、地山ＤＳの計測データを処理するためのアルゴリズムと、運搬車両ＬＳの計測データを処理するためのアルゴリズムとが選択されることにより、作業対象に関するパラメータ算出することができる。

【0103】

なお、上述の各実施形態において、ホイールローダ１が作業を実施する作業現場は、鉱山の採掘現場でもよいし、施工現場又は建設現場でもよい。

【0104】

なお、ホイールローダ１は、除雪作業に使用されてもよいし、農畜産業における作業に使用されてもよいし、林業における作業に使用されてもよい。

【0105】

なお、上述の各実施形態において、作業対象は、掘削対象及び積込対象に限られず、例えば盛土対象、整地対象、及び排土対象が含まれてもよい。また、作業モードは、掘削作業モードおよび積込作業モードに限られず、例えば盛土作業モード、整地作業モード、排土作業モード、除雪作業モード、待機モードが含まれてもよい。

【0106】

なお、上述の各実施形態において、算出部８６は、地山ＤＳに関するパラメータとして、ホイールローダ１から地山ＤＳまでの距離、及び地山ＤＳの安息角を算出することとした。算出部８６は、地山ＤＳに関する別のパラメータを算出してもよい。また、算出部８６は、運搬車両ＬＳにかするパラメータとして、ホイールローダ１から運搬車両ＬＳまでの距離、及びベッセルＢＥの高さを算出することとした。算出部８６は、運搬車両ＬＳに関する別のパラメータを算出してもよい。

【0107】

なお、上述の実施形態において、バケット１２は、複数の刃を有してもよいし、ストレート状の刃先を有してもよい。

【0108】

なお、ブーム１１の先端部に連結される作業部材は、バケット１２でなくてもよく、除雪作業に使用されるスノープラウ又はスノーバケットでもよいし、農畜産業の作業において使用されるベールグラブ又はフォークでもよいし、林業の作業において使用されるフォーク又はバケットでもよい。

【0109】

なお、作業機械は、ホイールローダに限定されず、例えば油圧ショベル又はブルドーザのような作業機を有する作業機械に上述の実施形態で説明した制御装置８０及び制御方法を適用することができる。

【0110】

なお、上述の実施形態においては、第１作業モードが掘削作業モードであり、第２作業モードが積込作業モードであることとした。作業モードは、掘削作業モード及び積込作業モードに限定されない。また、上述の実施形態においては、作業モードは第１作業モード及び第２作業モードの２種類の作業モードであることとしたが、３種類以上の作業モードでもよい。

【0111】

上述の実施形態においては、ホイールローダ１に搭載される計測装置が三次元計測装置２０であり、計測データ取得部８１が取得する計測データが作業対象の三次元形状を示す三次元データであることとしたが、これに限定されない。計測装置として、作業対象を計測する三次元計測装置２０のみならず、作業対象を撮影する写真計測装置であるカメラ、及び作業対象の位置を計測する位置計測装置がホイールローダ１に搭載されてもよい。また、計測装置が、上述の掘削物判定用センサ５１を含んでもよい。この場合、計測データ取得部８１が取得する計測データは、作業対象の三次元データのみならず、カメラによって撮影された作業対象の画像データ、位置計測装置によって計測された作業対象の位置データ、及び掘削物判定用センサ５１の検出データの少なくとも一つを含む。

【0112】

なお、上述の実施形態においては、算出部８６は、ホイールローダ１から作業対象までの距離として、バケット１２の先端部１２Ｂから作業対象までの距離を算出することとした。算出部８６は、バケット１２の任意の部位（例えば底面部）から作業対象までの距離を算出してもよいし、作業機１０の任意の部位から作業対象までの距離を算出してもよいし、車体２の任意の部位から作業対象までの距離を算出してもよい。

【0113】

上述の実施形態においては、アルゴリズム選択部８５は、掘削物判定部８３の判定データ及び前後進判定部８４の判定データに基づいて、ホイールローダ１の作業モードを判定したり、特定のアルゴリズムを選択したりすることとした。アルゴリズム選択部８５は、掘削物判定部８３の判定データ及び前後進判定部８４の判定データとは異なるその他のデータに基づいて、作業モードの判定又はアルゴリズムの選択を行ってもよい。その他のデータとして、例えば三次元計測装置２０の計測データである作業対象の三次元データ、掘削物判定用センサ５１の検出データ、ホイールローダ１に搭載されたカメラによって撮像された作業対象の画像データ、及びホイールローダ１に搭載された位置計測装置によって計測された作業対象の位置データの少なくとも一つが例示される。

【0114】

上述の実施形態において、アルゴリズム選択部８５は、作業モードを判定していたが、その形態に限られず、例えば、作業対象を何らかの手法により判定し、判定された作業対象に応じてアルゴリズムを選択してもよい。作業対象を判定する手法として、三次元計測装置２０の計測データである作業対象の三次元データ、掘削物判定用センサ５１の検出データ、ホイールローダ１に搭載されたカメラによって撮像された作業対象の画像データ、及びホイールローダ１に搭載された位置計測装置によって計測された作業対象の位置データの少なくとも一つを用いて作業対象を判定する手法が例示される。

【0115】

上述したように、ホイールローダ１の作業は、ホイールローダ１の作業モード及びホイールローダ１の作業対象に対する動作の少なくとも一方を含む概念である。アルゴリズム選択部８５は、ホイールローダ１の作業に応じて、アルゴリズムを選択することができる。アルゴリズム選択部８５は、ホイールローダ１の作業モードに応じてアルゴリズムを選択したり、及びホイールローダ１の作業対象に応じてアルゴリズムを選択したりすることができる。作業モードとは、ホイールローダ１が所定の動作を行う状態を含む。作業モードは、上述したような掘削作業モード又は積込作業モードのような単一の作業モードに加え、複数の作業モードを包括した作業モードも含む。複数の作業モードを包括した作業モードとして、上述の掘削作業モードＭ１、地山ＤＳから離れるモードＭ２、積込作業モードＭ３、及び運搬車両ＬＳから離れるモードＭ４の一連の作業モードを含む「Ｖシェープ作業モード」が例示される。

【0116】

なお、上述の実施形態においては、ホイールローダ１のトランスミッション装置３０及び走行操作装置４０は、運転者の操作により駆動されることした。トランスミッション制御部８８及び走行制御部８９が、トランスミッション装置３０及び走行装置４を自動制御してもよい。トランスミッション制御部８８及び走行制御部８９は、算出部８６により算出されたホイールローダ１から作業対象までの距離に基づいて、トランスミッション装置３０及び走行装置４を制御することができる。

【符号の説明】

【0117】

１…ホイールローダ（作業機械）、２…車体、２Ｆ…車体前部、２Ｒ…車体後部、３…運転台、４…走行装置、４Ａ…駆動装置、４Ｂ…ブレーキ装置、４Ｃ…操舵装置、５…車輪、５Ｆ…前輪、５Ｒ…後輪、６…タイヤ、６Ｆ…前タイヤ、６Ｒ…後タイヤ、９…関節機構、１０…作業機、１１…ブーム、１２…バケット、１２Ｂ…先端部、１３…ブームシリンダ、１４…バケットシリンダ、１５…ベルクランク、１６…リンク、２０…三次元計測装置、２１…レーザレーダ、２２…ステレオカメラ、３０…トランスミッション装置、４０…走行操作装置、４１…シフトレバー、５１…掘削物判定用センサ、５２…回転センサ、８０…制御装置、８１…計測データ取得部、８２…記憶部、８３…掘削物判定部、８４…前後進判定部、８５…アルゴリズム選択部、８６…算出部、８７…作業機制御部、８８…トランスミッション制御部、８９…走行制御部、ＢＥ…ベッセル（積込対象、作業対象）、ＤＳ…地山（掘削対象、作業対象）、ＬＳ…運搬車両、ＲＳ…地面。

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】

【図10】

【図11】

【図12】