JP7246294B2 - 計測装置、及び建設機械 - Google Patents

Description

本発明は、腕部材に対して回転可能に取り付けられた容器の収容物の体積を計測する技術に関するものである。

油圧ショベルにおいては、作業当日の作業量を把握するために、バケットが掘削した掘削物の体積が計算される。また、油圧ショベルが掘削物をダンプカーに積み込む作業を行うに場合、掘削物の体積がダンプカーの上限積載量を超えないように掘削物の体積が計算される。このように、掘削物の体積は、種々の用途に適用可能であるため、高精度に計算されることが望ましい。掘削物の体積を計算する技術として、下記の特許文献１、２が知られている。

特許文献１には、掘削後のバケットの状況を撮影した画像から算出されたバケットの表面形状と、排土後のバケット内の状況を撮影した画像から算出したバケットの内部形状との差を演算することにより、バケットの作業量を算出する技術が開示されている。

特許文献２には、掘削物が入った状態でバケットの開口面から掘削物表面までの長さと、バケットが空の時のバケットの底からバケットの開口面までの長さとを足すことにより、バケットの底から掘削物の表面までの長さを求め、この長さに基づいて掘削物の体積を計算する技術が開示されている。

特開２００８－２４１３００号公報 国際公開第２０１６／０９２６８４号

しかしながら、特許文献１の技術では、排土毎にバケットを所定の位置に移動させることが要求されるため、作業効率が低下する。

特許文献２の技術では、空状態のバケットがステレオカメラ装置で撮影され、撮影画像からバケットの底からバケットの開口面までの長さに基づいてバケットの形状が予め学習されている。

しかしながら、特許文献２の技術では、学習において、バケットの底から開口面までの長さが算出されているに過ぎず、バケットの姿勢データは計測されていない。そのため、特許文献２の技術は、学習時のバケットの姿勢と作業時のバケットの姿勢が異なる場合、掘削物の体積を精度よく算出できないという課題がある。

本発明の目的は、作業効率の低下を防止しつつ、バケットが収容する収容物の体積を正確に算出できる技術を提供することである。

本発明の一態様に係る計測装置は、本体部に対して起伏可能に取り付けられた腕部材であって、当該腕部材の姿勢の変更を可能にする１以上の関節を含む腕部材と、前記腕部材に対して回転可能に取り付けられる容器であって、当該容器に対する収容物の出入を許容する開口をもつ容器と、を含む作業装置において、前記容器の収容物の体積を計測する計測装置であって、前記腕部材に取り付けられ、物体の距離を示す計測データを計測する測距センサと、前記作業装置の姿勢を示す姿勢データを計測する姿勢センサと、前記測距センサにより計測された空状態の前記容器の前記計測データである第１計測データに基づいて前記容器の輪郭形状を示す第１形状データを算出する第１形状算出部と、前記第１計測データが計測された第１時点における前記姿勢データである第１姿勢データと前記第１形状データとを対応づけて記憶するメモリと、前記第１時点より後の第２時点において、前記測距センサにより計測された前記容器が収容する前記収容物の前記計測データである第２計測データに基づいて前記収容物の表面形状を示す第２形状データを算出する第２形状算出部と、前記第２時点において前記姿勢センサにより計測された前記姿勢データである第２姿勢データと前記第１姿勢データとの差を示す差分情報を算出する差分情報算出部と、前記第２時点における前記測距センサから前記容器までの前記作業装置の姿勢が前記第１時点における前記測距センサから前記容器までの前記作業装置の姿勢に一致するように、前記差分情報に基づいて、前記第２形状データを前記測距センサの３次元座標空間内で回転させる回転処理部と、回転された前記第２形状データと前記第１形状データとによって囲まれる領域を特定し、特定した前記領域に基づいて、前記第２時点における前記容器の前記収容物の体積を算出する体積算出部とを備える。

メモリには、第１時点における第１形状データと第１時点における空状態のバケットの第１姿勢データとが対応づけて記憶されている。第１時点より後の第２時点において計測された第２計測データに基づいて収容物の表面形状を示す第２形状データが算出される。第２時点における作業装置の第２姿勢データと第１時点における作業装置の第１姿勢データとの差を示す差分情報が算出される。第２形状データは、第２時点における測距センサから容器までの作業装置の姿勢が第１時点における測距センサから容器までの作業装置の姿勢に一致するように、第２形状データが、前記測距センサの３次元座標空間内で回転される。これにより、回転後の第２形状データは、第１時点における容器と同じ姿勢で計測された形状データとなる。その結果、回転後の第２形状データと第１形状データとに囲まれる領域に基づいて第２時点の収容物の体積が算出可能となり、収容物の体積を正確に算出できる。

また、上記メモリを備えているため、１度、空状態のバケットの第１形状データを算出すれば、以後、作業装置を所定の姿勢にしなくても、第２形状データから第２時点における収容物の体積が算出可能となる。その結果、収容物が収容される毎に作業装置を所定に姿勢にする必要がなくなり、作業効率の低下を防止できる。さらに、上記メモリを備えているため、第２形状データを算出する毎に収容物の体積を算出することが可能となり、この体積の算出処理をリアルタイムで実行できる。

上記計測装置において、前記第１形状データは、前記腕部材に対する前記容器の回転軸に対して直交する前記３次元座標空間内の平面に投影された前記容器の輪郭形状を示し、前記第２形状データは、前記平面に投影された前記収容物の表面形状を示し、前記回転処理部は、前記平面において、前記第２形状データを前記差分情報に基づいて回転させ、前記体積算出部は、前記平面において、回転された第２形状データと前記第１形状データとによって囲まれる領域を特定し、前記領域に基づいて前記収容物の断面積を算出し、前記断面積に前記容器の横幅を乗じて前記収容物の体積を算出することが好ましい。

この構成によれば、容器の長手方向に対して平行な座標空間内の平面において第２形状データが差分角度情報に基づいて回転される。回転後の第２形状データと前記平面における第１形状データとによって囲まれる領域が算出される。この領域に基づいて収容物の断面積が算出される。この断面積に収容物の横幅が乗じられて収容物の体積が算出される。そのため、収容物の体積を簡素な処理によって算出できる。

上記計測装置において、前記断面積は、前記第１形状データと前記第２形状データとによって囲まれる領域を複数の台形に区画し、各台形の面積を積算することによって算出されることが好ましい。

この構成によれば、第１形状データと第２形状データとによって囲まれる領域が複数の台形に区画され、各台形の面積が算出される。このように、断面積が台形近似されて算出されているため、この断面積を複数の四角形で近似した場合に比べて、断面積を正確に算出できる。

上記計測装置において、前記腕部材は、前記開口と対向する対向面を含み、前記測距センサは、前記対向面に取り付けられていることが好ましい。

この構成によれば、測距センサは、対向面に取り付けられているため、容器を開口側から計測可能となり、収容物の計測データを正確に計測できる。

上記計測装置において、前記腕部材は、建設機械の本体部に起伏可能に取り付けられていることが好ましい。

この構成によれば、建設機械が掘削した収容物の体積を算出できる。

上記計測装置において、前記収容物は、土砂であることが好ましい。

この構成によれば、容器が収容した土砂の体積を算出できる。

本発明の別の一態様にかかる建設機械は、本体部に対して起伏可能に取り付けられた腕部材であって、当該腕部材の姿勢の変更を可能にする１以上の関節を含む腕部材と、前記腕部材に対して回転可能に取り付けられるバケットとを含む作業装置と、前記腕部材に取り付けられ、物体の距離を示す計測データを計測する測距センサと、前記作業装置の姿勢を示す姿勢データを計測する姿勢センサと、前記測距センサにより計測された空状態の前記バケットの前記計測データである第１計測データに基づいて前記バケットの輪郭形状を示す第１形状データを算出する第１形状算出部と、前記第１計測データが計測された第１時点における前記姿勢データである第１姿勢データと、前記第１形状データとを対応づけて記憶するメモリと、前記第１時点より後の第２時点において、前記測距センサにより計測された前記バケットが収容する土砂の前記計測データである第２計測データに基づいて前記土砂の表面形状を示す第２形状データを算出する第２形状算出部と、前記第２時点において前記姿勢センサにより計測された前記姿勢データである第２姿勢データと前記第１姿勢データとの差を示す差分情報を算出する差分情報算出部と、前記第２時点における前記測距センサから前記バケットまでの前記作業装置の姿勢が前記第１時点における前記測距センサから前記バケットまでの前記作業装置の姿勢に一致するように、前記差分情報に基づいて、前記第２形状データを前記測距センサの３次元座標空間内で回転させる回転処理部と、回転された前記第２形状データと前記第１形状データとによって囲まれる領域を特定し、特定した前記領域に基づいて、前記第２時点における前記バケットの前記土砂の体積を算出する体積算出部とを備える。

本構成によれば、上記計測装置と同様、作業効率の低下を防止しつつ、バケットが収容する収容物の体積を正確に算出できる建設機械を提供できる。

本発明によれば、作業効率の低下を防止しつつ、バケットが収容する収容物の体積を正確に算出できる。

油圧ショベルの外観構成の一例を示す図である。 油圧ショベルの構成の一例を示すブロック図である。 第２コントローラに着目した場合の油圧ショベルの構成の一例を示すブロック図である。 計測モードにおける油圧ショベルの処理の一例を示すフローチャートである。 測距センサが計測した第１計測データの一例を示す図である。 バケット領域に設定された平面に含まれる画素データの一例を示す図である。 体積が算出される処理の一例を示すフローチャートである。 基準バケット角度を説明する図である。 第１形状データと第２形状データとが重畳される処理の説明図である。 土砂の断面積が算出される処理の説明図である。 土砂の体積の算出処理の説明図である。

以下、本実施の形態に係る計測装置が説明される。以下の例では計測装置が油圧ショベルに実装された例が説明される。なお、計測装置は、一部の構成要素が油圧ショベルに実装され、残りの構成要素が外部装置に実装されてもよい。外部装置としては、例えばクラウドサーバが採用される。計測装置は油圧ショベル１以外の建設機械に搭載されてもよい。さらに、計測装置は建設機械以外の作業機械に搭載されてもよい。この作業機械としては、容器を用いて物体を収容する機械であればどのような機械であってもよい。この作業機械の一例は、一以上の関節を含み姿勢が変更可能に構成された腕部材と、腕部材の先端部に回転可能に取り付けられた容器とを備える作業機械である。この容器は、開口を含み、土砂、パーティクルなどの収容物を収容するために用いられる。

図１は、油圧ショベル１の外観構成の一例を示す図である。油圧ショベル１は、下部走行体２、上部旋回体３、及び作業装置４を含む。下部走行体２は、例えば、地面に対して走行可能に構成されたクローラである。上部旋回体３は、下部走行体２の上部に設けられ、下部走行体２に対して鉛直軸回りに旋回可能に構成されている。上部旋回体３は、表示部８０及びコントローラ９０などが搭載されている。上部旋回体３は本体部の一例である。表示部８０は、操縦席に設けられ、オペレータに種々の情報を表示する。コントローラ９０は、油圧ショベル１の全体制御を司る。

作業装置４は、例えば掘削作業などの作業を行うために用いられる。作業装置４は、ブーム４０１、アーム４０２及びバケット４０３を含む。ブーム４０１は、上部旋回体３の前端に対して起伏可能に取り付けられている。アーム４０２は、ブーム４０１の先端部において水平軸回りに回動可能に取付けられている。バケット４０３は、アーム４０２の先端部において回転可能に取付けられる。バケット４０３は、収容物を収容する容器の一例である。ブーム４０１及びアーム４０２は腕部材の一例である。バケット４０３は、開口４０３ａを含む。バケット４０３は、掘削作業によって開口４０３ａから侵入する土砂を収容する。収容物の一例は、土砂である。

油圧ショベル１は、さらにブームシリンダ２１、アームシリンダ３１、及びバケットシリンダ４１を含む。

ブームシリンダ２１は、上部旋回体３とブーム４０１との間に介在する。ブームシリンダ２１は、伸縮することによりブーム４０１を起伏させる。

アームシリンダ３１は、ブーム４０１とアーム４０２との間に介在する。アームシリンダ３１は、伸縮することで、アーム４０２を回転させる。

バケットシリンダ４１は、アーム４０２とバケット４０３との間に介在する。バケットシリンダ４１は、伸縮することで、バケット４０３を回動させる。

油圧ショベル１は、さらにブーム角度センサ５１、アーム角度センサ５２、及びバケット角度センサ５３を含む。

ブーム角度センサ５１は、上部旋回体３に対するブーム４０１の起伏角度であるブーム角度を検出する。ブーム角度センサ５１は、例えばブーム４０１の根元側に設けられている。

アーム角度センサ５２は、ブーム４０１に対するアーム４０２の回転角度であるアーム角度を検出する。アーム角度センサ５２は、例えばアームの４０２の根元側に設けられている。バケット角度センサ５３は、アーム４０２に対するバケット４０３の回動角度であるバケット角度を検出する。バケット角度センサ５３は、例えばアーム４０２の先端部に設けられている。

測距センサ６０は、作業装置４に設けられ、物体の距離を示す計測データを計測する。測距センサ６０の一例は、ＴＯＦ（Ｔｉｍｅ ｏｆ Ｆｌｉｇｈｔ）センサ又はステレオカメラなどの複数の画素単位で深度が計測可能なセンサである。測距センサ６０はＬＩＤＡＲであってもよい。

測距センサ６０は、アーム４０２の裏面４０２ａに設けられている。測距センサ６０はセンサ面６０ａがバケット４０３側に向けられている。これにより、測距センサ６０は、バケット４０３の内面及びバケット４０３に収容された土砂の形状データが計測可能である。裏面４０２ａは、バケット４０３の開口４０３ａと対向する対向面の一例である。

測距センサ６０は、裏面４０２ａに対して取り外し可能に構成されてもよい。これにより、既存の油圧ショベル１に対して本実施の形態に係る作業装置を実装できる。この場合、測距センサ６０が取り付けられる度に、後述する計測モードが実行され、後述する第１形状データと姿勢データとがメモリに記憶される。さらに、この計測モードは、測距センサ６０が取り付けられた後、バケット４０３が交換された場合に実行されてもよい。さらに、測距センサ６０は、油圧ショベル１がデフォルトで備えるものであってもよい。この場合、この計測モードは、例えばバケット４０３が交換される都度、実行される。

本実施の形態では、油圧ショベル１は、オペレータのアーム４０２に対する操作によって、掘削動作と持ち上げ動作とを半自動的行う半自動運転モードを備える。この半自動運転モードにおいて、オペレータはアーム操作器を操作するだけで済む。アーム操作器の操作が開始されると、コントローラ９０は、作業装置４に掘削動作を開始させる。掘削動作では、バケット４０３を地面に侵入させた状態で、バケット４０３の先端部を地面と平行に移動させる動作が自動的に行われる。掘削動作によりバケット４０３に土砂が収容されると、持ち上げ動作が開始される。持ち上げ動作では、土砂を収容したバケット４０３が持ち上げられ、上部旋回体３が旋回され、所定位置においてバケット４０３が開かれて土砂が排土される一連の動作が自動的に行われる。

なお、掘削動作中において、アーム操作器がオペレータの操作によって中立位置に戻されると、コントローラ９０は、掘削動作を途中で停止させる。このことは、持ち上げ動作においても同じである。掘削動作及び持ち上げ動作中におけるバケット４０３の移動速度はアーム操作器に入力された操作量に応じた値に設定される。

このように、半自動運転モードでは、オペレータはアーム４０２の操作のみを行えば、後はコントローラ９０により自動的に掘削動作及び持ち上げ動作が行われる。したがって、油圧ショベル１に対する操縦経験が浅いオペレータであっても掘削動作及び持ち上げ動作を円滑に行うことができる。

図２は、油圧ショベル１の構成の一例を示すブロック図である。油圧ショベル１は、図１に示すコントローラ９０、測距センサ６０、及び表示部８０の他、アーム操作器１０、ブーム駆動回路２０、アーム駆動回路３０、バケット駆動回路４０、姿勢センサ５０、及びスイッチ７０を含む。図２のブロック図は、半自動運転モードを実行する上で必要なブロックのみが示されており、手動モードを実行する上で必要なブロックは図示が省略されている。

手動モードとは、コントローラ９０のアシストなしで、オペレータの操作のみに基づいて掘削動作及び持ち上げ動作などの動作を油圧ショベル１が行うモードである。なお、本発明においては、掘削動作及び持ち上げ動作は半自動運転モードによる実行に限定されず、手動モードで実行されてもよいし、完全自動運転モードで実行されてもよい。完全自動モードとは、オペレータにアーム４０２の操作を課すことなく、掘削動作及び持ち上げ動作を自動的に実行するモードである。この完全自動モードにおいては、オペレータは、例えば掘削開始ボタンを入力する操作を行うだけでよい。後は、コントローラ９０が、バケット４０３の移動速度を所定の速度に設定し、掘削動作及び持ち上げ動作を自動的に実行する。

アーム操作器１０は、アーム４０２を動かすためのアーム操作がオペレータにより入力される。アーム操作には、アーム４０２の先端部を上部旋回体３側に移動させるアーム引き操作及びアーム４０２の先端部を上部旋回体３の反対側に移動させるアーム押し操作が含まれる。

アーム駆動回路３０は、アーム４０２を駆動するための油圧回路である。アーム駆動回路３０は、図１に示すアームシリンダ３１の他、アームコントロールバルブ３２、アーム引きパイロット圧センサ３３、及びアームリモコン弁３４を含む。

アームシリンダ３１は、油圧ポンプからの作動油の供給を受けることにより伸縮し、これによりアーム引き動作とアーム押し動作とを行わせる。

アームコントロールバルブ３２は、アーム引きパイロットポート及びアーム押しパイロットポートを有するパイロット操作式の３位置方向切換弁で構成されている。アームコントロールバルブ３２は、アーム引きパイロットポートに入力されたアーム引きパイロット圧に対応するストロークで開弁する。この開弁により、アームシリンダ３１に供給される作動油の流量及び方向が制御され、アーム４０２の速度及び方向が制御され、アーム４０２はアーム引き動作を行う。アームコントロールバルブ３２は、アーム押しパイロットポートに入力されたアーム押しパイロット圧に対応するストロークで開弁する。この開弁により、アームシリンダ３１に供給される作動油の流量及び方向が制御され、アーム４０２の速度及び方向が制御され、アーム４０２はアーム押し動作を行う。

アーム引きパイロット圧センサ３３は、アームコントロールバルブ３２のアーム引きパイロットポートに入力されるアーム引きパイロット圧を検出し、コントローラ９０に入力する。

アームリモコン弁３４は、アーム操作器１０に入力されたアーム引き操作の操作量に対応した大きさのアーム引きパイロット圧をアームコントロールバルブ３２のアーム引きパイロットポートに入力する。アームリモコン弁３４は、アーム操作器１０に入力されたアーム押し操作の操作量に対応した大きさのアーム押しパイロット圧をアームコントロールバルブ３２のアーム押しパイロットポートに入力する。

ブーム駆動回路２０は、ブーム４０１を駆動するための油圧回路である。ブーム駆動回路２０は、図１に示すブームシリンダ２１の他、ブームコントロールバルブ２２、ブーム上げ流量操作弁２３を含む。

ブームシリンダ２１は、油圧ポンプからの作動油の供給を受けることにより伸縮し、これによりブーム上げ動作とブーム下げ動作とを行わせる。

ブームコントロールバルブ２２は、ブーム引きパイロットポート及びブーム押しパイロットポートを有するパイロット操作式の３位置方向切換弁で構成されている。ブームコントロールバルブ２２は、ブーム上げパイロットポートに入力されたブーム上げパイロット圧に対応するストロークで開弁する。この開弁により、ブームシリンダ２１に供給される作動油の流量及び方向が制御され、ブーム４０１の速度及び方向が制御され、ブーム４０１はブーム上げ動作を行う。ブームコントロールバルブ２２は、ブーム下げパイロットポートに入力されたブーム下げパイロット圧に対応するストロークで開弁する。この開弁により、ブームシリンダ２１に供給される作動油の流量及び方向が制御され、ブーム４０１の速度及び方向が制御され、ブーム４０１はブーム下げ動作を行う。

ブーム上げ流量操作弁２３は、パイロット油圧源（図略）からブーム上げパイロットポートに入力されるパイロット圧をコントローラ９０から入力されるブーム流量指令信号に応じて減圧する。これにより、コントローラ９０は、ブーム上げパイロットポートに入力されるパイロット圧をブーム上げ流量操作弁２３を通じて自動操作する。

バケット駆動回路４０は、バケット４０３を駆動するための油圧回路である。バケット駆動回路４０は、図１に示すバケットシリンダ４１の他、バケットコントロールバルブ４２、バケット掬い流量操作弁４３を含む。

バケットシリンダ４１は、油圧ポンプからの作動油の供給を受けることにより伸縮し、これによりバケット掬い動作とバケット開き動作とを行わせる。

バケットコントロールバルブ４２は、バケット掬いパイロットポート及びバケット開きパイロットポートを有するパイロット操作式の３位置方向切換弁で構成されている。バケットコントロールバルブ４２は、バケット掬いパイロットポートに入力されたバケット掬いパイロット圧に対応するストロークで開弁する。この開弁により、バケットシリンダ４１に供給される作動油の流量及び方向が制御され、バケット４０３の速度及び方向が制御され、バケット４０３はバケット掬い動作を行う。バケットコントロールバルブ４２は、バケット開きパイロットポートに入力されたバケット開きパイロット圧に対応するストロークで開弁する。この開弁により、バケットシリンダ４１に供給される作動油の流量及び方向が制御され、バケット４０３の速度及び方向が制御され、バケット４０３はバケット開き動作を行う。

バケット掬い流量操作弁４３は、パイロット油圧源（図略）からバケット掬いパイロットポートに入力されるパイロット圧をコントローラ９０から入力されるバケット流量指令信号に応じて減圧する。これにより、コントローラ９０は、バケット掬いパイロットポートに入力されるパイロット圧をバケット掬い流量操作弁４３を通じて自動操作する。

姿勢センサ５０は、図１に示すブーム角度センサ５１、アーム角度センサ５２、及びバケット角度センサ５３を含む。

ブーム角度センサ５１、アーム角度センサ５２、及びバケット角度センサ５３は、それぞれ、例えば所定の演算周期でブーム角度、アーム角度、及びバケット角度をコントローラ９０に入力する。

測距センサ６０は、所定の演算周期で計測した計測データをコントローラ９０に入力する。計測データは、測距センサ６０の視野内にある物体の深度を複数の画素毎に示す距離画像データで構成されている。

スイッチ７０は、油圧ショベル１のモードを切り替えるためのオペレータからの操作が入力されるスイッチである。スイッチ７０は、操縦席に設けられた物理的なスイッチであってもよいし、表示部８０に表示されるグラフィカルユーザインターフェースであっってもよい。

コントローラ９０は、ＣＰＵ及びメモリを含むコンピュータまたは専用の電気回路で構成されている。コントローラ９０は、第１コントローラ１１０及び第２コントローラ１２０を含む。

第１コントローラ１１０は、半自動運転モードにおける油圧ショベル１の制御を司る。第１コントローラ１１０は、バケット位置演算部１１１、掘削動作制御部１１２、目標速度演算部１１３、及び持ち上げ動作制御部１１４を含む。

バケット位置演算部１１１は、ブーム角度センサ５１、アーム角度センサ５２、及びバケット角度センサ５３により計測されたブーム角度、アーム角度、及びバケット角度に基づいて、バケット４０３の特定部位の位置を算出する。この特定部位の一例は、バケット４０３の先端位置である。この特定部位の位置は、例えば既知のブーム長、アーム長、及びバケット長と、計測されたブーム角度、アーム角度、及びバケット角度とに基づく幾何演算により算出される。この先端位置は、例えば、所定の演算周期で算出される。

さらに、目標速度演算部１１３は、アーム引きパイロット圧センサ３３により計測されたアーム引きパイロット圧と、バケット位置演算部１１１により算出されたバケット４０３の特定部位の位置とに基づいて、ブーム４０１及びバケット４０３のそれぞれの目標速度を算出する。

掘削動作中におけるブーム４０１の目標速度は、例えば予め定められた目標施工面に施工面を近づけるためのブーム４０１の上げ方向の目標速度である。掘削動作中におけるバケット４０３の目標速度は、アーム引き動作に従って、バケット４０３の特定部位を目標施工面に沿って自動的に平行移動させるためのバケット４０３の目標速度である。

持ち上げ動作中におけるブーム４０１の目標速度は、例えば掘削動作終了後にバケット４０３を予め定められた排土位置に移動させるための、ブーム４０１の上げ方向の目標速度である。持ち上げ動作中におけるバケット４０３の目標速度は、例えば掘削動作終了後にバケット４０３を予め定められた排土位置に移動させるためのバケット４０３の掬い方向の目標速度である。

掘削動作制御部１１２は、目標速度演算部１１３によって算出された掘削動作におけるブーム４０１及びバケット４０３のそれぞれの目標速度で、ブーム４０１及びバケット４０３のそれぞれが動作するように、ブーム上げ流量操作弁２３及びバケット掬い流量操作弁４３のそれぞれを制御する。この制御により掘削動作の半自動運転が実現される。

持ち上げ動作制御部１１４は、目標速度演算部１１３によって算出された持ち上げ動作におけるブーム４０１及びバケット４０３のそれぞれの目標速度で、ブーム４０１及びバケット４０３のそれぞれが動作するように、ブーム上げ流量操作弁２３及びバケット掬い流量操作弁４３のそれぞれを制御する。この制御により持ち上げ動作の半自動運転が実現される。

掘削動作と持ち上げ動作との切り替えは目標速度演算部１１３により行われる。例えば、目標速度演算部１１３は、掘削動作が終了すると、掘削動作制御部１１２に掘削動作を終了させ、持ち上げ動作制御部１１４に持ち上げ動作を開始させる。一方、目標速度演算部１１３は、持ち上げ動作中において排土が終了した場合、持ち上げ動作制御部１１４に持ち上げ動作を終了させ、掘削動作制御部１１２に掘削動作を開始させればよい。

第２コントローラ１２０は、バケット４０３が収容する土砂の体積を算出する処理を制御するものである。図３は、第２コントローラ１２０に着目した場合の油圧ショベル１の構成の一例を示すブロック図である。

第２コントローラ１２０は、第１形状算出部１２１、第２形状算出部１２２、姿勢データ取得部１２３、メモリ１２４、差分情報算出部１２５、回転処理部１２６、及び体積算出部１２７を含む。

第１形状算出部１２１は、測距センサ６０により計測された空状態のバケット４０３の計測データである第１計測データに基づいてバケット４０３の輪郭形状を示す第１形状データを算出する。第１形状算出部１２１の処理の詳細は、例えば以下の通りである。まず、第１形状算出部１２１は、第１計測データに含まれる複数の画素データのうち深度が閾値以下の画素データを抽出する。この閾値は、第１計測データに含まれる油圧ショベル１の画素データを、油圧ショベル１の背景となる画素データと区別するために予め定められた値を持つ。これにより、第１計測データから空状態のバケット４０３を示す画素データが抽出される。次に、第１形状算出部１２１は、抽出された複数の画素データのそれぞれを測距センサ６０の３次元座標空間に配置する３次元座標変換を行う。次に、第１形状算出部１２１は、３次元座標空間に配置された画素データのうち、バケット４０３の長手方向に対して平行な平面上に位置する画素データを第１形状データとして抽出する。これにより、前記平面に投影されたバケット４０３の輪郭形状を示す第１形状データが得られる。バケット４０３の長手方向に対して平行な平面とは、アーム４０２に対するバケット４０３の回転軸に直交する平面である。

姿勢データ取得部１２３は、第１計測データが計測される第１時点における姿勢データである第１姿勢データと、第１形状算出部１２１により算出された第１形状データとを対応づけてメモリ１２４に記憶させる。以下の説明では、第１姿勢データは、第１時点におけるバケット角度であるものとする。但し、これに限定されず、第１姿勢データには、第１時点におけるアーム角度、及びブーム角度が含まれてもよい。

本実施の形態では、計測モードにおいて、オペレータの操作によってバケット４０３の姿勢が予め定められた基準バケット角度になった時点が第１時点とされる。この場合、姿勢データ取得部１２３は、姿勢センサ５０が計測した計測データをモニタし、バケット角度が基準バケット角度になったことを検出した場合に、第１形状算出部１２１により算出された第１形状データを基準バケット角度と対応づけてメモリ１２４に記憶させればよい。但し、これは一例であり、油圧ショベル１の稼働中において、例えばオペレータがスイッチ７０に計測指示を入力した時点が第１時点として採用されてもよい。この場合、姿勢データ取得部１２３は、第１時点において姿勢センサ５０により計測されたバケット角度を第１形状データと対応づけてメモリ１２４に記憶させればよい。

さらに、姿勢データ取得部１２３は、第１時点より後の第２時点において、姿勢センサ５０により計測される第２姿勢データを取得する。以下の説明では、第２姿勢データは、第２時点におけるバケット角度であるものとする。但し、これに限定されず、第２姿勢データには、第２時点におけるアーム角度及びブーム角度が含まれていてもよい。

メモリ１２４は、例えばソリッドステートドライブ及びフラッシュメモリなどの不揮発性の記憶装置で構成される。メモリ１２４は、第１形状データ及び第１姿勢データを対応づけて記憶する。

第２形状算出部１２２は、第１時点より後の第２時点において、測距センサ６０により計測されたバケット４０３が収容する土砂の計測データである第２計測データに基づいて土砂の表面形状を示す第２形状データを算出する。第２時点は、例えば掘削動作期間及び／又は持ち上げ動作期間を所定の演算周期で区切ったサンプリング時点を示す。第２形状算出部１２２の処理の詳細は、例えば以下の通りである。まず、第２形状算出部１２２は、第２計測データに含まれる複数の画素データのうち深度が閾値以下の画素データを抽出する。この閾値は、第１形状算出部１２１が使用した上述の閾値と同じである。これにより、第２計測データからバケット４０３に収容された土砂を開口４０３ａから見たときの画素データが抽出される。抽出される画素データにはバケット４０３の縁の画素データが含まれていてもよい。次に、第２形状算出部１２２は、抽出された複数の画素データのそれぞれを測距センサ６０の３次元座標空間に配置する３次元座標変換を行う。次に、第２形状算出部１２２は、３次元座標空間に配置された画素データのうち、バケット４０３の長手方向に対して平行な平面上に位置する画素データを第２形状データとして抽出する。これにより、前記平面に投影された土砂の輪郭形状を示す第２形状データが得られる。

第２形状データは、例えば、油圧ショベル１の稼働中において所定の演算周期で繰り返し算出されてもよいし、掘削動作中及び／又は持ち上げ動作中において所定の演算周期で繰り返し算出されてもよい。

差分情報算出部１２５は、第２時点において姿勢センサ５０により計測された姿勢データである第２姿勢データと第１姿勢データとの差を示す差分情報を算出する。本実施の形態では、測距センサ６０はアーム４０２に取り付けられているため、差分情報算出部１２５は、第２時点において姿勢センサ５０により計測されたバケット角度と、メモリ１２４に記憶されたバケット角度との差分角度を差分情報として算出する。

回転処理部１２６は、第２時点における測距センサ６０からバケット４０３までの作業装置４の姿勢が第１時点における測距センサ６０からバケット４０３までの作業装置４の姿勢に一致するように、差分情報に基づいて、第２形状データを、測距センサ６０の３次元座標空間内で回転させる。本実施の形態では、測距センサ６０はアーム４０２に取り付けられている。そのため、回転処理部１２６は、第１時点における測距センサ６０からバケット４０３までの作業装置４の姿勢と、第２時点における測距センサ６０からバケット４０３までの作業装置４の姿勢とが一致するように、第２形状データを回転させる。具体的には、回転処理部１２６は、第２時点におけるバケット角度と第２時点におけるバケット角度とが一致するように第２形状データを差分角度回転させる。

例えば、差分角度Δθが第２時点のバケット角度から第１時点のバケット角度を減じた値であるとすると、回転処理部１２６は、前記平面において第２形状データを－Δθ回転させる行列演算を行うことによって第２形状データを回転させればよい。

測距センサ６０からのバケット４０３の内面の見え方は、バケット角度に応じて異なるが、第２形状データをこのように回転させることで、第２形状データを第１時点のバケット角度と同じバケット角度で計測された形状データにすることができる。

体積算出部１２７は、回転処理部１２６によって回転された第２形状データと、メモリ１２４に記憶された第１形状データとによって囲まれる領域を特定し、特定した領域に基づいて、第２時点においてバケット４０３が収容する土砂の体積を算出する。具体的には、体積算出部１２７は、前記領域の面積をバケット４０３が収容する土砂の断面積として算出し、この断面積にバケット４０３の横幅を乗じることで土砂の体積を算出すればよい。

ここで、体積算出部１２７は、前記領域を複数の台形に区画し、各台形の面積を積算することで前記断面積を算出すればよい。

スイッチ７０は、半自動運転モード、手動モード、又は完全自動モードで油圧ショベル１を駆動させるオペレータの指示を受け付ける。さらに、スイッチ７０は、油圧ショベル１の動作モードを上述した計測モードにするためのオペレータの指示又は第１時点を指定するための計測指示を受け付ける。

表示部８０は、体積算出部１２７が算出した体積を示す画像を表示する。表示される体積は１回の掘削動作により掘削された土砂の体積であってもよい。

次に、計測モードにおける処理について説明する。図４は、計測モードにおける油圧ショベル１の処理の一例を示すフローチャートである。計測モードは、例えば油圧ショベル１の動作モードを計測モードにするためのオペレータの指示がスイッチ７０に入力されたときに開始される。

ステップＳ１では、測距センサ６０は、オペレータの操作によって基準バケット角度に位置決めされたバケット４０３の計測データを第１計測データとして計測する。図８は、基準バケット角度θｒｅｆを説明する図である。図８の例では、横方向から見たときのアーム４０２及びバケット４０３が示されている。横方向とは、バケット４０３の回転軸と平行な方向である。長手方向Ｌ１はブーム４０１の先端部４０１ｂとアーム４０２の先端部４０２ｂとを繋ぐ直線の方向である。

図８の例では、バケット角度θは、バケット４０３の長手方向Ｌ２と基準方向Ｌｒｅｆとのなす角度である。長手方向Ｌ２は、アーム４０２の先端部４０２ｂとバケット４０３の先端部４０３ｂとを繋ぐ直線の方向である。基準方向Ｌｒｅｆは、長手方向Ｌ１と長手方向Ｌ２とが１直線に揃ったときの長手方向Ｌ２である。バケット角度θは、基準方向Ｌｒｅｆに対して先端部４０３ｂがアーム４０２の裏面４０２ａに近づく回転方向（図８の例では反時計回りの回転方向）がプラスであり、先端部４０３ｂが裏面４０２ａから離れる回転方向（図８の例では時計回りの回転方向）がマイナスである。このプラスとマイナスの関係は逆であってもよい。

基準バケット角度θｒｅｆの一例は、１２０度である。なお、基準バケット角度θｒｅｆは、測距センサ６０の視野内にバケット４０３の内面の全域が入る角度であればどのような角度が採用されてもよい。

第２コントローラ１２０は、計測モードの開始時に、空状態のバケット４０３のバケット角度を基準バケット角度にするための操作をオペレータに促す映像を表示部８０に表示してもよい。

図４に参照を戻す。ステップＳ２では、第１形状算出部１２１は、ステップＳ１で計測された第１計測データを３次元座標空間に配置する３次元座標変換を行う。

ステップＳ３では、第１形状算出部１２１は、３次元座標空間に配置された画素データのうち、バケット４０３の長手方向に対して平行な平面上に位置する画素データを第１形状データとして算出する。

図５は、測距センサ６０が計測した第１計測データの一例を示す図である。図５に示すように、第１計測データには、開口４０３ａ側から見たバケット４０３の内面を示す画素データからなるバケット領域５０１と、バケット４０３の背景とが含まれていることがわかる。ここでは、説明の便宜上、バケット領域５０１の濃度は一定で表されているが、実際にはこの濃度は測距センサ６０とバケット４０３との距離に応じた濃淡で表される。さらに、背景の濃度は白一色で表されているが、実際には、この濃度はバケット４０３の周囲にある物体（例えば、地面）と測距センサ６０との距離に応じた濃淡で表される。

第１形状算出部１２１は、図５に示されるような第１計測データから深度が閾値以下の画素データを抽出し、３次元座標空間に配置する。これにより、バケット領域５０１を構成する画素データが３次元座標空間に配置される。

第１形状算出部１２１は、３次元座標空間に配置された画素データに平面５０２を設定する。この平面５０２は、バケット４０３の長手方向Ｌ２と平行且つバケット４０３の開口面と直交する平面である。さらに、この平面５０２は、バケット４０３の横方向のほぼ中央に設定されている。次に、第１形状算出部１２１は、バケット領域５０１の画素データのうち、平面５０２に含まれる画素データを抽出する。

図６は、バケット領域５０１に設定された平面５０２に含まれる画素データの一例を示す図である。平面５０２は縦方向にＹ軸、横方向にＺ軸が設定されている。Ｙ軸は測距センサ６０の３次元座標空間における高さ方向を示す。Ｚ軸はこの３次元座標空間における奥行き方向を示す。なお、この３次元座標空間は、Ｘ、Ｙ、Ｚの３軸からなる３次元直交座標系の空間である。Ｘ軸は油圧ショベル１の横方向を示す。

平面５０２には、空状態のバケット４０３の内面を示す複数の画素データ６０２が配置されている。第１形状データ６０１は、これら複数の画素データ６０２により構成される。以上により第１形状データ６０１が算出される。

図４に参照を戻す。ステップＳ４では、姿勢データ取得部１２３は、第１形状データと基準バケット角度とを対応づけてメモリ１２４に記憶する。

以上により計測モードの処理が終了される。続いて、バケット４０３が収容する土砂の体積を算出する処理が説明される。図７は、体積が算出される処理の一例を示すフローチャートである。なお、図７のフローは所定の演算周期で繰り返し実行される。図７のフローの１ループの処理は第２時点における処理となる。

ステップＳ１１では、測距センサ６０は、第２時点における計測データである第２計測データを計測する。ステップＳ１２では、姿勢データ取得部１２３は、第２時点において姿勢センサ５０により計測されたバケット角度を取得する。

ステップＳ１３では、第２形状算出部１２２は、第２計測データから深度が閾値以下の画素データを抽出し、抽出した画素データを３次元座標空間に配置する。

ステップＳ１４では、第２形状算出部１２２は、３次元座標空間に配置された画素データのうち平面５０２にある画素データを抽出することで第２形状データを算出する。これにより、第２時点においてバケット４０３が収容する土砂の表面の輪郭形状を示す第２形状データが得られる。

ステップＳ１５では、差分情報算出部１２５は、ステップＳ１２で取得されたバケット角度と、メモリ１２４に記憶された基準バケット角度との差分角度を算出する。

ステップＳ１６では、回転処理部１２６は、ステップＳ１４で算出された第２形状データをステップＳ１５で算出された差分角度、回転させる。回転処理の詳細は上述したため、ここでは説明が省略される。

ステップＳ１７では、体積算出部１２７は、第１形状データと、ステップＳ１６で回転された第２形状データとを平面５０２に重畳する。図９は、第１形状データ６０１と第２形状データ９０１とが重畳される処理の説明図である。図９において左図はメモリ１２４に記憶された第１形状データ６０１を示し、中図は回転後の第２形状データを示し、右図は重畳後の第１形状データ６０１及び第２形状データ９０１を示している。

中図に示されるように回転処理により、第２形状データ９０１は、基準バケット角度と同じバケット角度で計測された形状データにされている。そのため、右図に示すように、平面５０２に第１形状データ６０１と第２形状データ９０１とを重畳させることで、第１形状データ６０１と第２形状データ９０１とで取り囲まれる領域１００１が形成される。

図７に参照を戻す。ステップＳ１８では、体積算出部１２７は、バケット４０３に収容された土砂の断面積を算出する。図１０は、土砂の断面積が算出される処理の説明図である。

体積算出部１２７は、平面５０２に配置された第１形状データ６０１を構成する画素データ６０２を用いて第１形状データ６０１の輪郭線６０１１を算出する。さらに、体積算出部１２７は、平面５０２に配置された回転後の第２形状データ９０１を用いて第２形状データ９０１の輪郭線９０１１を算出する。そして、体積算出部１２７は、輪郭線６０１１と輪郭線９０１１とにより囲まれる領域１００１を抽出する。

領域１００１を抽出した体積算出部１２７は、領域１００１をＹ軸と平行な複数の直線１００３で区切り、各直線１００３と輪郭線６０１１との交点、並びに各直線１００３と輪郭線９０１１との交点を求める。交点を求めた体積算出部１２７は、隣接する交点同士を直線でつなぐ。これにより、領域１００１は、長手方向がＹ軸と平行であり、Ｚ軸方向に配列された複数の台形１００２に区画される。この区画が終了した体積算出部１２７は、各台形１００２の面積を求め、求めた面積を積算する。これにより、台形近似により領域１００１の面積、すなわち、土砂の断面積が算出される。

図７に参照を戻す。ステップＳ１９では、体積算出部１２７は、ステップＳ１８で算出した土砂の断面積にバケット４０３の横幅を乗じることで、土砂の体積を算出する。ステップＳ１９の処理が終了すると、処理はステップＳ１１に戻される。

図１１は、土砂の体積の算出処理の説明図である。図１１に示すように、土砂の体積は、ステップＳ１８で算出された土砂の断面積に予め定められたバケット４０３の横幅１１０１を乗じることで算出される。横幅１１０１は、例えばメモリ１２４に記憶されている。

以上説明したように、本実施の形態によれば、第１時点において、空状態のバケット４０３の形状データである第１形状データが算出され、第１時点におけるバケット角度と対応づけてメモリ１２４に記憶される。第２時点において、土砂を収容したバケット４０３の形状データである第２形状データが算出される。第１時点におけるバケット角度と第２時点におけるバケット角度との差分角度が算出される。第２形状データは、座標空間内において差分角度回転される。これにより、回転後の第２形状データは、第１時点におけるバケットと同じ姿勢で計測された形状データとなる。その結果、回転後の第２形状データと第１形状データとに囲まれる領域に基づいて第２時点の収容物の体積が算出可能となり、収容物の体積を正確に算出できる。

また、メモリ１２４を備えているため、１度、空状態のバケットの第１形状データを算出すれば、以後、作業装置を所定の姿勢にしなくても、第２形状データから第２時点における収容物の体積が算出可能となる。その結果、収容物が収容される毎に作業装置を所定に姿勢にする必要がなくなり、作業効率の低下を防止できる。さらに、メモリ１２４を備えているため、第２形状データを算出する毎に収容物の体積を算出することが可能となり、この体積の算出処理をリアルタイムで実行できる。

本発明は、下記の変形例が採用できる。

（１）図５の例では、第１形状データは１枚の平面５０２に位置する画素データで構成されていたが、本発明はこれに限定されない。第１形状データは、Ｎ（２以上の整数）枚の平面５０２のそれぞれに配置された画素データで構成されてもよい。第２形状データも、第１形状データと同様、Ｎ枚の平面５０２のそれぞれに配置された画素データで構成されてもよい。

この場合、第２コントローラ１２０は下記の処理により土砂の体積を算出すればよい。まず、回転処理部１２６は、Ｎ枚の平面５０２のそれぞれに配置された第２形状データを差分角度回転させる。次に、体積算出部１２７は、回転後のＮ個の第２形状データと、Ｎ個の第２形状データに対応するＮ個の第１形状データとによって囲まれるＮ個の断面積を算出する。Ｎ個の第２形状データに対応するＮ個の第１形状データとは、例えば、１枚目の平面５０２に配置された第２形状データにおいては、１枚目の平面５０２に配置された第１形状データが該当し、例えば２枚目の平面５０２に配置された第２形状データにおいては、２枚目の平面５０２に配置された第１形状データが該当する。次に、体積算出部１２７は、Ｎ個の断面積の積算値を土砂の体積として算出する。この構成によれば、土砂の体積がより正確に算出される。

（２）図１の例では、測距センサ６０は、アーム４０２の裏面４０２ａに取り付けられていたが、本発明はこれに限定されない。測距センサ６０は、ブーム４０１の裏面４０１ａに取り付けられていてもよい。

この場合の第２コントローラ１２０の処理は、下記の通りである。姿勢データ取得部１２３は、第１時点におけるバケット角度及びアーム角度を第１姿勢データとして取得し、第１姿勢データを第１形状算出部１２１により算出された第１形状データと対応づけてメモリ１２４に記憶する。姿勢データ取得部１２３は、第２時点におけるバケット角度及びアーム角度を第２姿勢データとして取得する。差分情報算出部１２５は、第２時点におけるアーム角度と第１時点におけるアーム角度との差分角度であるアーム差分角度を算出する。差分情報算出部１２５は、第２時点におけるバケット角度と第１時点におけるバケット角度との差分角度であるバケット差分角度を算出する。回転処理部１２６は、第２時点におけるアーム４０２及びバケット４０３の姿勢が第１時点におけるアーム４０２及びバケット４０３の姿勢と一致するように、アーム差分角度とバケット差分角度とを用いて第２形状データを回転させる。

回転処理が終了すると、体積算出部１２７は、上記と同様に、回転後の第２形状データと第１形状データとを用いて土砂の体積を算出する。

この構成によれば、測距センサ６０がブーム４０１に取り付けられた場合においても、バケット４０３が収容する体積が算出可能となる。

さらに、測距センサ６０は上部旋回体３の前面に取り付けられてもよい。この場合、第１時点におけるブーム角度、アーム角度、及びバケット角度と、第２時点におけるブーム角度、アーム角度、及びバケット角度とのそれぞれの差分角度である、ブーム差分角度、アーム差分角度、及びバケット差分角度を算出する。回転処理部１２６は、第２時点におけるブーム４０１、アーム４０２、及びバケット４０３の姿勢が第１時点におけるブーム４０１、アーム４０２、及びバケット４０３の姿勢と一致するように、ブーム差分角度とアーム差分角度とバケット差分角度とを用いて第２形状データ９０１を回転させる。

回転処理が終了すると、体積算出部１２７は、上記と同様に回転後の第２形状データ９０１と第１形状データとを用いて土砂の体積を算出する。この構成によれば、上部旋回体３に測距センサ６０が取り付けられている場合において、作業装置４の上部旋回体３側の部材に測距センサ６０が取り付けられている場合において、バケット４０３が収容する土砂の体積が算出可能となる。

（３）上記実施の形態において、計測装置は油圧ショベル１に適用されたがこれに限定されない。計測装置は、油圧ショベル１などの建設機械以外の機械、例えばアームロボットに適用されてもよい。このアームロボットは、本体部と作業装置とを備えている。作業装置は本体部に対して回動自在に取り付けられた腕部材と、腕部材の先端に回動可能に取り付けられた容器とを含む。腕部材は１以上の関節を含みその姿勢が変更可能に構成されている。容器は、掬い動作により例えば収容物を収容し、特定の位置にて収容物を排出する。収容物は、例えばポップコーンのような粒状の食品であってもよいし、ビーズのような食品とは異なる物質であってもよいし、粉末薬品などであってもよい。この構成によれば、計測装置をアームロボットに適用した場合においても、容器が収容する収容物の体積が算出可能となる。

（４）図１の例では、第２コントローラ１２０は、油圧ショベル１に実装されたが、これに限定されない。第２コントローラ１２０は、油圧ショベル１に対してネットワークを介して接続されたサーバに実装されてもよい。この場合、サーバは、油圧ショベル１に実装された測距センサ６０及び姿勢センサ５０から姿勢データ及び計測データを取得すればよい。ネットワークは例えばローカルエリアネットワークであってもよいし、インターネット及び携帯電話通信網を含むワイドエリアネットワークであってもよい。

（５）上記実施の形態において表示部８０はバケット４０３が収容する土砂の体積を示す画像を表示するが、本発明はこれに限定されない。例えば、体積算出部１２７は、算出した体積に予め定められた土砂の比重を乗じることで土砂の重量を算出し、表示部８０に表示させてもよい。この構成によれば、オペレータにバケット４０３が収容する土砂の重量が報知可能となる。さらに、体積算出部１２７は、算出した重量から油圧ショベル１の作業量を算出して表示部８０に表示してもよい。この場合、体積算出部１２７は、例えば１日あたり、１時間あたりなどの単位時間あたりにバケット４０３が収容した土砂の体積の合計値を算出し、この合計値に基づいて単位時間あたりの作業量を算出すればよい。

さらに、体積算出部１２７は、算出した体積の合計値が土砂の排土先となるダンプトラックの上限積載量以上になった場合、そのことを示す情報を表示部８０に表示させてもよい。

１ ：油圧ショベル
２ ：下部走行体
３ ：上部旋回体
４ ：作業装置
６０ ：測距センサ
６１ ：ブーム角度センサ
７０ ：スイッチ
８０ ：表示部
９０ ：コントローラ
１１０ ：第１コントローラ
１２０ ：第２コントローラ
１２１ ：第１形状算出部
１２２ ：第２形状算出部
１２３ ：姿勢データ取得部
１２４ ：メモリ
１２５ ：差分情報算出部
１２６ ：回転処理部
１２７ ：体積算出部
６０１ ：第１形状データ
９０１ ：第２形状データ

Claims (7)

1. 本体部に対して起伏可能に取り付けられた腕部材であって、当該腕部材の姿勢の変更を可能にする１以上の関節を含む腕部材と、前記腕部材に対して回転可能に取り付けられる容器であって、当該容器に対する収容物の出入を許容する開口をもつ容器と、を含む作業装置において、前記容器の収容物の体積を計測する計測装置であって、
   前記腕部材に取り付けられ、物体の距離を示す計測データを計測する測距センサと、
   前記作業装置の姿勢を示す姿勢データを計測する姿勢センサと、
   前記測距センサにより計測された空状態の前記容器の前記計測データである第１計測データに基づいて前記容器の輪郭形状を示す第１形状データを算出する第１形状算出部と、
   前記第１計測データが計測された第１時点における前記姿勢データである第１姿勢データと前記第１形状データとを対応づけて記憶するメモリと、
   前記第１時点より後の第２時点において、前記測距センサにより計測された前記容器が収容する前記収容物の前記計測データである第２計測データに基づいて前記収容物の表面形状を示す第２形状データを算出する第２形状算出部と、
   前記第２時点において前記姿勢センサにより計測された前記姿勢データである第２姿勢データと前記第１姿勢データとの差を示す差分情報を算出する差分情報算出部と、
   前記第２時点における前記測距センサから前記容器までの前記作業装置の姿勢が前記第１時点における前記測距センサから前記容器までの前記作業装置の姿勢に一致するように、前記差分情報に基づいて前記第２形状データを前記測距センサの３次元座標空間内で回転させる回転処理部と、
   回転された前記第２形状データと前記第１形状データとによって囲まれる領域を特定し、特定した前記領域に基づいて、前記第２時点における前記容器の前記収容物の体積を算出する体積算出部とを備える、
   計測装置。
2. 前記第１形状データは、前記腕部材に対する前記容器の回転軸に対して直交する前記３次元座標空間内の平面に投影された前記容器の輪郭形状を示し、
   前記第２形状データは、前記平面に投影された前記収容物の表面形状を示し、
   前記回転処理部は、前記平面において、前記第２形状データを前記差分情報に基づいて回転させ、
   前記体積算出部は、前記平面において、回転された第２形状データと前記第１形状データとによって囲まれる領域を特定し、前記領域に基づいて前記収容物の断面積を算出し、前記断面積に前記容器の横幅を乗じて前記収容物の体積を算出する、
   請求項１記載の計測装置。
3. 前記断面積は、前記第１形状データと前記第２形状データとによって囲まれる領域を複数の台形に区画し、各台形の面積を積算することによって算出される、
   請求項２記載の計測装置。
4. 前記腕部材は、前記開口と対向する対向面を含み、
   前記測距センサは、前記対向面に取り付けられている、
   請求項１～３のいずれかに記載の計測装置。
5. 前記腕部材は、建設機械の本体部に起伏可能に取り付けられている、
   請求項１～４のいずれかに記載の計測装置。
6. 前記収容物は、土砂である、
   請求項１～５のいずれかに記載の計測装置。
7. 本体部に対して起伏可能に取り付けられた腕部材であって、当該腕部材の姿勢の変更を可能にする１以上の関節を含む腕部材と、前記腕部材に対して回転可能に取り付けられるバケットとを含む作業装置と、
   前記腕部材に取り付けられ、物体の距離を示す計測データを計測する測距センサと、
   前記作業装置の姿勢を示す姿勢データを計測する姿勢センサと、
   前記測距センサにより計測された空状態の前記バケットの前記計測データである第１計測データに基づいて前記バケットの輪郭形状を示す第１形状データを算出する第１形状算出部と、
   前記第１計測データが計測された第１時点における前記姿勢データである第１姿勢データと、前記第１形状データとを対応づけて記憶するメモリと、
   前記第１時点より後の第２時点において、前記測距センサにより計測された前記バケットが収容する土砂の前記計測データである第２計測データに基づいて前記土砂の表面形状を示す第２形状データを算出する第２形状算出部と、
   前記第２時点において前記姿勢センサにより計測された前記姿勢データである第２姿勢データと前記第１姿勢データとの差を示す差分情報を算出する差分情報算出部と、
   前記第２時点における前記測距センサから前記バケットまでの前記作業装置の姿勢が前記第１時点における前記測距センサから前記バケットまでの作業装置の姿勢に一致するように、前記差分情報に基づいて、前記第２形状データを前記測距センサの３次元座標空間内で回転させる回転処理部と、
   回転された前記第２形状データと前記第１形状データとによって囲まれる領域を特定し、特定した前記領域に基づいて、前記第２時点における前記バケットの前記土砂の体積を算出する体積算出部とを備える、
   建設機械。

Images