以下、鉱山等で採掘した砕石や鉱物等を運搬する大型の作業車両であるダンプトラックに適用した場合を例にとって本発明の実施の形態を図面を用いて説明する。なお、本発明の適用はダンプトラックに限定されるものではない。
図1は本発明の作業車両の移動物体検知システムの第1の実施の形態を備えたダンプトラックを示す側面図である。
図1に示すダンプトラック(自車両)1は、頑丈なフレーム構造で形成された車体2と、車体2上に起伏可能に搭載されたベッセル(荷台)3と、車体2に装着された左前輪4A(L)及び左後輪4B(L)を主に備えている。
車体2には、後輪4Bを駆動するエンジン(図示せず)が配設されている。エンジンは、例えば、エンジン制御装置(以下ECUという)を有し、ECUからの指令信号によって、供給される燃料流量が制御されることで、その回転数が制御されている。
ベッセル3は、砕石物等の荷物を積載するために設けられた容器であり、ピン結合部5等を介して車体2に対して起伏可能に連結されている。ベッセル3の下部には、車両の幅方向に所定の間隔を介して2つの起伏シリンダ6が設置されている。起伏シリンダ6に圧油が供給・排出されると、起伏シリンダ6が伸長・縮短してベッセル3が起伏される。また、ベッセル3の前側上部には庇部7が設けられている。
庇部7は、その下側(すなわち車体2の前部)に設置された運転室8を岩石等の飛散物から保護するとともに、車両転倒時等に運転室8を保護する機能を有している。運転室8の内部には、作業車両の移動物体検知システムを構成する制御装置の車体近傍移動物体検知装置100(図4参照)と、操舵用のハンドル(図示せず)と、ダンプトラック(自車両)1の進行の可否とその進行方向を指示するためのシフトレバー18と、アクセルペダル及びブレーキペダル等(図示せず)とが設置されている。シフトレバー18(後の図10参照)は少なくとも前後方向及びその中間位置に操作可能であり、シフトレバー18の状態、すなわちダンプトラック1の進行方向に関する設定を電気的に検知するシフトレバー状態センサ19(後の図10参照)を含み、シフトレバー状態センサ19が検出したシフトレバー18の状態を車体近傍移動物体検知装置100に出力する。
図2は本発明の作業車両の移動物体検知システムの第1の実施の形態におけるカメラの配置を説明する概念図、図3は本発明の作業車両の移動物体検知システムの第1の実施の形態を構成するカメラが撮影した映像を示す概念図である。
図2において、ダンプトラック1の車体2の前側面と後側面とには、ダンプトラック1の前方を広角で撮影する前方カメラ301と、ダンプトラック1の後方を広角で撮影する後方カメラ303とが設けられている。また、車体2の左側面と右側面とには、ダンプトラック1の左方向を広角で撮影する左方向カメラ302と、ダンプトラック1の右方向を広角で撮影する右方向カメラ304とが設けられている。これらのカメラ301〜304は、それぞれの地表面を主に撮影できるように、車体2の各面に俯角をつけて取付けられている。また、ダンプトラック1の車体2には、右前輪4A(R)と右後輪4B(R)と左前輪4A(L)と左後輪4B(L)とが装着されている。
図3はこれらのカメラ301〜303が撮影した周囲映像の例を示す。401は前方カメラ301が撮影した前方映像の例を示す。402は左方向カメラ302が撮影した左方向映像の例を示す。403は後方カメラ303が撮影した後方映像の例を示す。404は右方向カメラ304が撮影した右方向映像の例を示す。
周囲映像401〜404は、それぞれ広角で撮影されるため遠方、すなわち各映像の上部に映し出されている地平線が湾曲して見えている。また、近傍、すなわち各映像の下部に車体2の一部が映っている。例えば、前方映像401には、車体2のフロント部分の一部が、左方向映像402には、車体2の左サイド部分と左前輪4A(L)及び左後輪4B(L)がそれぞれ映っている。右方向映像404には、車体2の右サイド部分と右前輪4A(R)及び右後輪4B(R)が、後方映像403には、車体2のリア部分と左後輪4B(L)と右後輪4B(R)、並びに映像内の上部に自車両1のベッセル3の一部がそれぞれ映っている。
なお、この例ではカメラに広角レンズを用いているため、ベッセル3の映っている箇所のような特に映像の辺縁部では歪みが大きくなっている。また、同一の車輪が複数のカメラに映る場合がある。前方映像401、左方向映像402、後方映像403、右方向映像404を合わせたものが本実施の形態における周囲映像である。
図4は本発明の作業車両の移動物体検知システムの第1の実施の形態の構成を示すブロック図である。図4において、作業車両の移動物体検知システムの第1の実施の形態は、車体近傍移動物体検知装置100と、カメラ101とを備えている。
カメラ101は、1個または複数の撮像装置で構成されていて、自車周囲の様子を撮影し、撮影結果である周囲映像401〜404を車体近傍移動物体検知装置100へ送信する。
車体近傍移動物体検知装置100は、映像合成器102と移動物体検知器103と検知位置判定部104と検知結果追跡部105と検知情報データベース106と検知画像取得部107と表示装置108と更新演算部109とを備えている。
映像合成器102は、カメラ101が送信した周囲映像の中から必要な部分を切り出し、座標変換と合成を行なうのと同時に、入力した検知位置座標を基に移動物体の検知結果抽出映像を合成し、得られた合成映像を表示装置108に送出する。
移動物体検知器103は、カメラ101の送出する周囲映像に関して検知処理を行い、移動物体が映像中に存在するか否かを検知し、移動物体を検知した場合は検知した位置を示す検知位置座標を周囲映像とともに検知位置判定部104と映像合成器102とへ送出する。
検知位置判定部104は、移動物体検知器103が移動物体を検知した場合に、後述する検知結果追跡部105からの過去の移動物体と同一であるか否かの信号と移動物体検知器103から送出された現在の移動物体の検知位置座標から、過去の検知位置に比べてより遠方に位置しているか(周囲映像の中では、過去の検知位置より上方に位置しているか)どうかを判定し、その結果を検知結果追跡部105と更新演算部109へ送出する。
検知結果追跡部105は、移動物体検知器103が検知した移動物体が、時間推移に伴って移動する方向を追跡し、ある時刻に検知した移動物体と、別の時刻に検知した移動物体とが同一であるかどうかを判定するとともに、同一の移動物体の場合には、同一の移動物体識別子を付与した判定結果を検知位置判定部104へ送出する。
検知情報データベース106は、移動物体検知器103が送出する移動物体の検知位置と検知した移動物体の画像、及びこの移動物体に関して検知結果追跡部105が送出する移動物体識別子を保持し、必要に応じて保持した検知情報を更新演算部109へ送出する。
更新演算部109は、検知位置判定部104において判定した結果及び検知結果追跡部105の出力する移動物体識別子(以降、単に識別子と記載する)を基に、検知した移動物体が過去の検知位置に比べてより遠方(上方)に位置している場合には、周囲映像の中から検知位置座標にもとづいて抽出した移動物体の画像を検知情報データベース106に識別子と対応づけて記録する。一方、検知した移動物体が過去の検知位置に比べてより遠方に位置していない場合は、現在の識別子と同じ識別子とともに検知情報データベース106内に保持している移動物体の画像を取得し、検知画像取得部107へ送出する。
検知画像取得部107は、更新演算部109から取得した移動物体の画像を映像合成器102に送出する。
表示装置108は、例えばディスプレイを備え、映像合成器102から入力した合成映像を利用者に対して出力する。
なお、車体近傍移動物体検知装置100において、表示装置108以外の構成要素である各演算部等はコントローラの一機能として構成されている。
次に、本発明の作業車両の移動物体検知システムの第1の実施の形態における移動物体の検知と表示の処理内容について図5乃至図9を用いて説明する。図5は本発明の作業車両の移動物体検知システムの第1の実施の形態における処理内容を示すフローチャート図、図6は本発明の作業車両の移動物体検知システムの第1の実施の形態における移動物体の検知の例を示す概念図、図7は本発明の作業車両の移動物体検知システムの第1の実施の形態における検知情報データベースに保持される情報の一例を示す概念図、図8は本発明の作業車両の移動物体検知システムの第1の実施の形態における移動物体検知の結果表示の一例を示す概念図、図9は本発明の作業車両の移動物体検知システムの第1の実施の形態における移動物体検知の結果表示の他の例を示す概念図である。図5乃至図9において、図1乃至図4に示す符号と同符号のものは同一部分であるので、その詳細な説明は省略する。
図5において、車体近傍移動物体検知装置100は、周囲映像入力を行う(ステップS201)。具体的には、図4に示す映像合成器102と移動物体検知器103とはカメラ101で撮影した周囲映像401〜404を入力する。
車体近傍移動物体検知装置100は、移動物体検知処理を実行する(ステップS202)。具体的には図4に示す移動物体検知器103が移動物体検知処理を実行する。検知の対象とする映像は、カメラ101から入力する前方映像401、左方向映像402、後方映像403、右方向映像404である。
検知処理の一例を図6を用いて説明する。図6は左方向映像402における移動物体の検知を示すものであって、上から順に、(a)ある特定時刻t0より前の時刻である時刻t0−1における映像、(b)ある特定時刻t0における映像、(c)移動物体の検知結果を示す映像、(d)移動物体の検知結果の追跡映像を示している。
ここで、図6(a)には、時刻t0−1における移動物体501が左方向映像402上に撮影されている様子が示され、図6(b)には特定時刻t0における移動物体502が左方向映像402上に撮影されている様子が示されている。これらの移動物体501と502は車両であって同一のものであり、時間の推移に伴って移動している様子が左方向カメラ302によって撮影されている。図6(a)〜(d)では、移動物体が自車体の側面より数メートル離れた位置に存在している様子を示している。
図4に示す移動物体検知器103は、カメラ101から入力するこれらの映像を比較し、時間の推移に伴って映像に変化が発生した箇所を算出する。移動物体検知器103での算出により得られた、図6(c)に示す検知結果503について、検知位置判定部104の処理により左方向映像402上での座標情報を取得する。なお、映像に変化が発生していない場合はこのような検知結果は得られない。
図5に戻り、移動物体検知器103は、ステップS202における処理結果を判定する(ステップS203)。移動物体を検知した場合には、ステップS204へ進み、それ以外の場合には、ステップS212へ進む。
車体近傍移動物体検知装置100は、追跡状態の取得の処理を実行する(ステップS204)。具体的には以下の処理を行なう。
(1)図4に示す検知位置判定部104は、移動物体検知器103にて検知した移動物体が、カメラ101からの入力映像内で見かけ上存在している位置、すなわち図6(d)に示す現在の検知結果503の位置から、過去の検知位置に比べてより遠方に位置しているか(周囲映像の中では、過去(例えば前回)の検知位置より上方に位置しているか)どうかを判定し、その結果を検知結果追跡部105へ送出する。
(2)検知結果追跡部105は、検知情報データベース106にて保持している検知結果の情報の中から、図6(d)に示す前回の検知結果504の位置情報を取得し、これらの位置情報と上述の現在の検知位置とを比較して、現在と前回の検知結果の間の距離505が予め定めた設定値内にあるかどうかを判定する。距離505が設定値内にある場合に、前回の検知結果504と現在の検知結果503が同一の移動物体を指していると判定し、それ以外の場合は同一の物体を指していないと判定する。
(3)なお、ここで用いる過去の検知結果は前回の検知結果に限られるものではなく、例えば、現在から予め定めた時間だけ前の検知結果を用いるように構成しても良い。また、現在と前回の検知結果の間の距離505における設定値とは、例えば車両や人物といった移動物体が、最大速度で移動した場合に、現在と前回との演算間隔において、映像内で見かけ上移動する距離を用いて定めても良い。また、前回の検知結果504が複数存在する場合は、現在と前回の検知結果の間の距離505が最も小さいものを対象として、上述の処理を行う。
図5に戻り、車体近傍移動物体検知装置100の検知位置判定部104は、ステップS204における処理結果から現在の検知結果503が新規の検知か否かを判定する(ステップS205)。具体的には、ステップS204において、同一の移動物体と判定された前回の検知結果504が存在するか否かを確認し、前回の検知結果504が存在しない場合には、現在の検知結果503は新規の検知であると判定する。新規の検知である場合にはステップS206へ進み、それ以外の場合にはステップS210へ進む。
車体近傍移動物体検知装置100の検知結果追跡部105は、ステップS205で新規の検知と判定された場合に、判定された新規の検知情報に対して、他の検知結果の情報との区別を可能とするために新たな識別子を生成する(ステップS206)。識別子は、例えば整数の数値を用意しておき、新規の検知が発生するたびに1ずつ増加させた数値を割り当てる方法を用いても良い。識別子は、現在の検知結果503と連係させて検知情報データベース106に記録する。ここで、検知情報データベース106に記録する情報について図7を用いて説明する。
図7において、601は1個の検知結果に関連する情報である検知結果情報を示す。検知結果情報601は、識別子602と検知結果映像603と映像記録位置604と検知結果の現在位置605とを備えている。
識別子602は、上述したようにステップS206で生成される数値が保持されていて、その後、他の1個の検知結果に対して他の数値が付与される。他のいずれの検知結果における数値とも異なる。
検知結果映像603は、識別子602によって識別する検知結果について、カメラ101からの入力映像の1こまが保持されている。
映像記録位置604は、現在保持されている検知結果映像603を撮影した入力映像上の位置を示す値が保持されている。例えばカメラ入力映像の平面に対して水平方向の位置をxで表し、垂直方法の位置をyで表す場合、(x,y)の形式の値が保持される。
検知結果の現在位置605は、識別子602で規定される検知結果が、現在、存在する入力映像内の位置を示す値が保持されている。位置の表示形式は、映像記録位置604における形式と同等である。本実施の形態において、後述するステップS207〜209においても検知結果情報601を用いて処理を行なう。
図5に戻り、車体近傍移動物体検知装置100は、検知映像の記録を行なう(ステップS207)。具体的には、更新演算部109が図6(c)に示す現在の検知結果503の映像を、現在の検知結果503と連係した識別子602を持つ検知結果情報601内の検知結果映像603として登録し、登録した検知結果情報601を検知情報データベース106に記録する。
車体近傍移動物体検知装置100は、映像位置の更新を行なう(ステップS208)。具体的には、更新演算部109がステップS207にて登録した検知結果映像603の存在する位置を、映像記録位置604として登録し、登録した検知結果情報601を検知情報データベース106に記録する。ここでの位置とは入力映像内における位置を示している。
車体近傍移動物体検知装置100は、検知情報の記録を行なう(ステップS209)。具体的には、更新演算部109が現在の検知結果503の入力映像内で存在する位置を、検知結果の現在位置605として登録し、登録した検知結果情報601を検知情報データベース106に記録する。この後、ステップS212へ進む。
ステップS205において、現在の検知結果503は新規の検知でないと判定した場合、車体近傍移動物体検知装置100は、検知位置の算出を行なう(ステップS210)。具体的には、検知位置判定部104が図6(c)に示す現在の検知結果503の入力映像内で存在する位置から現地位置を算出する。入力映像内で、現在の検知結果503の範囲を示す領域、図6(c)に示す車両を囲む矩形の範囲の中心を検知結果の現在位置605として取得することができる。
車体近傍移動物体検知装置100は、現在の検知位置が過去の検知位置に比べて遠方に位置しているか否かを判定する(ステップS211)。具体的には、検知位置判定部104が検知結果情報601において、検知結果の現在位置605と、映像記録位置604とを比較する。映像記録位置604よりも、検知結果の現在位置605の方が、入力映像においてより上方に存在する、すなわち実際の周囲環境においてはより遠方に存在する場合は、検知結果情報601として現在の検知結果503に関する情報に置き換えるためにステップS207に進み、それ以外の場合は置き換えが不要であるためステップS209に進む。
ステップS203において、移動物体を検知しなかった場合、またはステップS209の処理を実行した後、車体近傍移動物体検知装置100は、合成映像の構築を行なう(ステップS212)。具体的には、映像合成器102が前方映像401、左方向映像402、後方映像403、右方向映像404の映像を変換して合成すると共に、検知情報データベース106に保持されている検知結果503の映像を検知画像取得部107から取得して合成し、自車両1とその周囲を俯瞰するような合成映像を構築する。このようにして構成した例を図8に示す。
図8において、映像合成器102が変換した前方映像701は、図3に示す前方映像401を、前方映像401に映る地表面の鉛直上方から撮影したように(つまり、上方視点となるように)視点変換した映像であり、同様に、変換した左方向映像702は左方向映像402を、変換した後方映像703は後方映像403を、変換した右方向映像704は右方向映像404をそれぞれ変換した映像である。自車アイコン705は、視点変換した際に自車両1が存在する位置に描画する模式的な画像である。これらの上方視点に視点変換した画像を変換後の各視点を中心に合わせて、各視点を合わせた仮想視点を中心として構築した映像が、俯瞰合成映像706である。つまり、自車アイコン705は、俯瞰画像(俯瞰合成映像706)の仮想視点を中心に俯瞰画像上における自車の形状および大きさを示すものである。この俯瞰合成映像706は表示装置108の表示内容となる。
また、左方向映像402の中で検知した現在の検知結果503が、視点変換に伴って、変換した左方向映像を702の中に表示されている。さらに、自車アイコン705の位置には、現在の検知結果503と連係した検知結果情報601の保持する検知結果映像603を表示し、現在の検知結果503と検知結果映像603とが同一の対象であることを示すために、双方を矢印で接続するように表示している。
なお、図8のように検知結果映像603を表示する際に、検知結果情報601に保持している検知結果映像603の大きさと表示先の領域の大きさとが異なる場合には、検知結果映像603の大きさを、表示先の領域の大きさに合わせて拡大または縮小してから表示する。なお、後述する実施例においても、検知結果映像603を表示する際は、このような拡大または縮小を実行するものとする。
ところで、現在の検知結果503に示される車両が、自車両1に接近して移動する場合の検知結果の表示の例を図9に示す。自車両1に取り付けた前方カメラ301、左方向カメラ302、後方カメラ303、右方向カメラ304は、周囲を移動する車両などの検知対象に比べて高い位置に存在するため、これらのカメラから撮影した映像内では、検知対象が遠方に存在する場合は検知対象の側面がより多く撮影され、近傍に存在する場合は上面がより多く撮影される。このため、図9の自車両1に接近した検知結果801については、検知対象となっている車両の上面が主に撮影されている。ここで遠方とは、例えばカメラ101を地表面から高さ4メートルの位置に設けた状態で、カメラ101から鉛直下向きに引いた線が地表面と交わる地点から水平方向に4メートル以上離れている領域を指す。
ここで、カメラ101から鉛直下向きに引いた線が地表面と交わる地点から4メートル離れている地点は、カメラ101の位置から斜め下45度の位置関係となる。検知対象となる車両は主に直方体で構築されていることから、斜め下45度の位置関係にある検知対象を撮影すると、検知対象の上面及び側面のいずれも、視線に対して直行する角度から45度だけ回転した状態となり、実際の上面と側面が同じ面積であれば、カメラ101で撮影した見かけ上の上面と側面が同等の面積になる。したがって、この地点を境に検知対象となる車両がカメラ101から離隔するにつれて見かけ上の側面の面積がより広くなる。このように、検知対象となる車両の見かけ上の側面の面積がより広くなる領域を遠方と定義している。
なお、カメラ101と検知対象との距離が大きくなると、カメラ取得映像内での検知対象が見かけ上小さくなり、撮影する検知対象の解像度が低くなって画質が低下し、利用者による判別を困難にさせる可能性がある。このため、処理の対象とする距離の範囲を定めるものする。例えば、カメラ101から鉛直下向きに引いた線が地表面と交わる地点よりの相対値で0メートルから10メートルといった上限値及び下限値を設けて、その領域内における検知対象に対して処理を行なうようにしても良い。
図9における検知結果映像603は、図8における検知結果映像603と同じ映像が使用されている。図8の現在の検知結果503に示される車両が、自車両1に接近して移動した場合、図5に示すステップS211において、現在の検知位置が過去の検知位置に比べて遠方に位置していないので、処理はステップS209へ進む。このことにより、前回の処理のステップS207において記録した検知結果映像603は更新されずに残るためである。
検知結果映像603に対してこのような処理を行なうのは、以下の理由による。
(1)車両の上面を撮影した状態では、映像内で見えているのは、屋根やボンネットが主体となっている。これに比べて、車両の側面を撮影した状態では、映像内で見えているのは、車両のフロントグリルやサイドドア、車輪等が主体であり、車両の種類の判別がしやすい。
(2)検知結果が人物の場合には、上面を撮影した状態では、作業用のヘルメットの上部が見える程度であるのに比べて、側面を撮影した状態では、ヘルメットの他に顔、服装、靴などが見えるため、人物の作業役割や個人の特定などが行いやすい。
(3)図9において、接近した検知結果801では車両の上面のみが表示されているが、検知結果映像603では側面が表示されていることから、検知対象がどのようなものであるかの理解を促進させることが可能になる。
なお、図8や図9において、現在の検知結果503と同様に、異なる検知結果が複数存在する場合は、自車アイコン705上で他の検知結果が描かれていない位置(すなわち描画可能な位置)に、検知結果映像を複数個、描画することが可能である。
図5に戻り、車体近傍移動物体検知装置100は、合成映像の出力を行なう(ステップS213)。具体的には、映像合成器102がステップS212において構築した俯瞰合成映像706を、表示装置108に出力する。
車体近傍移動物体検知装置100は、移動物体検知の処理が終了したかどうかを判定する(ステップS214)。利用者のシステム操作等により終了と判定した場合は処理を終了し、それ以外の場合は処理をステップS201に戻る。
以上の処理により、検知結果映像603を自車アイコン705の位置で確認できるため、利用者が、接近した検知結果801に対してどのような対応をとれば良いかを迅速に判断でき、作業効率を向上させることが可能となる。
上述した本発明の作業車両の移動物体検知システムの第1の実施の形態によれば、検知対象がより遠方に存在している状態において対象物の画像を取得し保持し、自車両の周囲の実際の映像を用いて検知結果を利用者に示すので、利用者が対象物の個体を識別しやすくなる。これにより、利用者は実施すべき操作を迅速に決定することができる。この結果、作業全体の運用効率を向上することができる。
なお、本実施の形態においては、カメラ101として4台のカメラを使用し映像を取得した場合を例に説明しているが、台数に関してはこれより多い場合と少ない場合いずれにおいても本発明による手法は適用可能である。
以下、本発明の作業車両の移動物体検知システムの第2の実施の形態を図面を用いて説明する。図10は本発明の作業車両の移動物体検知システムの第2の実施の形態の構成を示すブロック図、図11は本発明の作業車両の移動物体検知システムの第2の実施の形態における移動物体検知の結果表示の一例を示す概念図、図12は本発明の作業車両の移動物体検知システムの第2の実施の形態における合成映像の構築処理の詳細を示すフローチャート図である。図10乃至図12において、図1乃至図9に示す符号と同符号のものは同一部分であるので、その詳細な説明は省略する。
本実施の形態における作業車両の移動物体検知システムは、その構成及び運用方法は第1の実施の形態と大略同様である。第2の実施の形態においては、検知結果が複数個存在する場合に、表示手法を選定する処理を行なう点が第1の実施の形態と異なる。
本実施の形態における車体近傍移動物体検知装置100の構成は、図10に示すように、車両状態抽出装置2001と、優先画像構築部2002と、シフトレバー18とが追加されている点が第1の実施の形態と異なる。車両状態抽出装置2001は、自車両1の進行方向を指示するシフトレバー18の状態をシフトレバー状態センサ19によって取得し、このシフトレバー18の状態信号を優先画像構築部2002に出力する。優先画像構築部2002は、車両状態抽出装置2001からの自車両1のシフトレバーの状態信号と検知画像取得部107を介して得られる検知結果の位置を入力し、これらの信号から自車両1の進行方向、または近傍に存在する検知結果の状態を優先して表示する指令を検知画像取得部107へ出力する。
本実施の形態においては、図11に示すように、自車両1の周囲に3台の車両(以降、第1〜第3の車両と称する)が移動していてそれぞれが検知されている場合を例に説明する。すなわち、俯瞰合成映像706上に、第1の車両の検知結果901、第2の車両の検知結果902、及び第3の車両の検知結果903が存在する。ここで、各検知結果に関する検知結果情報601を識別しやすくするため、第1の車両の検知結果901における情報を、第1の検知結果情報601(901)とし、内包する識別子602や検知結果現在位置605に関しては、第1の識別子602(901)および第1の検知結果現在位置605(901)と表記する。同様に、第2の車両の検知結果902における情報を第2の検知結果情報601(902)と、第3の車両の検知結果903における情報を第3の検知結果情報601(903)と表記する。
次に、本実施の形態における合成映像の構築処理の詳細内容を、図12を用いて説明する。本実施の形態における処理の流れは、図5に類似するが、ステップS212の処理内容を更に詳しく説明するものである。
車体近傍移動物体検知装置100は、図5のステップS203またはステップS209から処理が移った場合、まず、合成映像の部分構築を行なう(ステップS1001)。具体的には、映像合成器102は、検知結果映像603以外の部分を対象として、上述したステップS212と同様の処理にて合成映像の構築を行う。検知結果映像603の処理に関しては次のステップ以降で行う。
優先画像構築部2002は、俯瞰合成映像706の中に検知結果が存在するか否かを判定する(ステップS1002)。検知結果が複数存在する場合、以降の処理を検知した複数の検知結果のそれぞれについて繰り返して実行するようにループ処理を行うため、ここでは一度ループ処理した(つまり、後述のステップS1003〜S1005の一連の処理を一度行った)検知結果は次回以降のループ処理の対象外とし、一度もループ処理されていない残りの検知結果が存在するか否かを判定する。ステップS1002において、一度もループ処理されていない検知結果が存在する場合はステップS1003へ進み、それ以外の場合はステップS1006へ進む。
車体近傍移動物体検知装置100は、ステップS1002で存在すると判定された検知結果のうちの1個の検知結果と自車両1との位置関係を判定するために自車両1の進行方向で検知したか否かを判定する(ステップS1003)。具体的には、優先画像構築部2002が車両状態抽出装置2001によって自車両1のシフトレバー18の状態を取得し、シフトレバー18がフォワードに設定されていて、かつ検知結果が、俯瞰合成映像706において自車アイコン705の幅に当たる部分を前方に延長した範囲(自車両1の進行方向)に存在するか否か、又は、シフトレバー18がリバースに設定されていて、かつ検知結果が、俯瞰合成映像706において、自車アイコン705の幅に当たる部分を後方に延長した範囲(自車両1の進行方向)に存在するか否かを判定する。検知結果が自車両1の進行方向に存在する場合は、ステップS1004へ進み、それ以外の場合、すなわち、検知結果が自車両1の進行方向(すなわち、シフトレバー18の設定方向)に存在しない場合、又は、シフトレバー18がニュートラルに設定されていて自車両1の前後方向への移動が行われない場合は、ステップS1002に戻る。
優先画像構築部2002は、ステップS1003で自車両1の進行方向に存在すると検知された検知結果がそれ以前のループ処理で自車両1に最も近い位置にあると判定された他の検知結果よりも自車両1に近い位置(つまり、自車両1の最も近い位置)にあるか否かを判定する(ステップS1004)。図11に示すように、複数の検知結果情報601(図11の例では、第1の検知結果情報601(901)、第2の検知結果情報601(902)、第3の検知結果情報601(903))が存在する場合、それぞれが保持する識別子602は互いに異なっている。優先画像構築部2002は、このような複数の検知結果情報601が保持している検知結果現在位置605(図11の例では、第1の検知結果現在位置605(901)、第2の検知結果現在位置605(902)、第3の検知結果現在位置605(903))をそれぞれ取得し、ステップS1004で判定対象としている1個の検知結果情報601が保持する検知結果現在位置605と、それ以前のループ処理のステップS1004で自車両1に最も近い位置にあると判定された他の検知結果の検知結果情報601が保持する検知結果現在位置605とを比較して、対象としている検知結果が他の検知結果よりも近い位置にあるかどうかを判定することにより、対象としている検知結果が自車両1の最も近い位置にあるか否かを判定する。対象としている1個の検知結果の検知結果情報601が保持する検知結果現在位置605が、それ以前のループ処理のステップS1004で自車両1に最も近い位置にあると判定された他のどの検知結果の検知結果情報601が保持する検知結果現在位置605よりも自車両1に近い値を示している場合は、ステップS1005へ進み、それ以外の場合は、ステップS1002に戻る。なお、判定の対象としている1個の検知結果がステップS1004の判定対象となる前に自車両1に最も近い位置にあると判定された他の検知結果が無い場合は、必然的に今回のループ処理における判定対象の検知結果が自車両1に最も近い位置にあると判定される。
優先画像構築部2002は、ステップS1004で自車両1に最も近い位置にあると判定された検知結果について、検知結果の映像の更新を行なう(ステップS1005)。つまり、ステップS1005では、自車アイコン705上に表示する検知結果映像603を、ステップS1004までで判定した結果にもとづいて設定する。図11の例において、シフトレバー18がフォワードに設定されているとすると、第1の車両の検知結果901は自車両1の進行方向にはない。また、第2の車両の検知結果902と第3の車両の検知結果903は自車両1の進行方向にあって、かつ第2の車両の検知結果902の方が自車両1に近い。このことから、第2の車両の検知結果902に対応する第2の車両の検知結果映像904を、自車アイコン705上に表示する検知結果映像603(902)として設定する。
ステップS1005の処理を実行後、ステップS1002へ進む。ステップS1002において、俯瞰合成映像706の中に未処理の検知結果が存在しなくなった場合、ステップS1006へ進む。
車体近傍移動物体検知装置100の映像合成器102は、ステップS1005で更新された検知結果映像に基づいて検知結果の画像を描画する(ステップS1006)。映像合成器102は優先画像構築部2002による処理の結果を検知画像取得部107を介して取得して、合成映像の全体を表示装置108に描画する。
なお、上述したステップS1002〜S1005の処理において、検知結果が1個以上存在するにもかかわらず自車アイコン705上に表示する検知結果映像603が設定されなかった場合(すなわち、ステップS1005の処理を行う検知結果が無い場合)は、存在する検知結果の中で最も自車両1に近いものの検知結果情報601が保持する検知結果映像603を使用する。例えば、図11において、第2の車両の検知結果902及び第3の車両の検知結果903が存在せず第1の車両の検知結果901のみが存在する場合は、これまでの処理の中では検知結果映像の更新(ステップS1005)が行われない。この場合には、存在する検知結果の中で最も自車両1に近い検知結果として第1の車両の検知結果901の保持する検知結果映像603(901)を自車アイコン705上に表示する。この後、処理をステップS213に移す。
上述した処理を行なうことで、複数の検知結果が存在する場合に、自車両1の進行方向、または自車両1の近傍に存在する検知結果の状態を優先して表示することが可能になる。これにより、自車両1が移動を開始する際、周囲に存在する検知対象の中で、最も注意すべき範囲、すなわち自車両1の移動方向である前後方向、または自車両1の近傍に存在する検知対象の状況をより明確に把握することが可能になる。
上述した本発明の作業車両の移動物体検知システムの第2の実施の形態によれば、上述した第1の実施の形態と同様の効果を得ることができる。
また、上述した本発明の作業車両の移動物体検知システムの第2の実施の形態によれば、複数の検知結果が存在する場合に、自車両の前後方向、または自車両の近傍に存在する検知結果の状態を優先して表示することが可能になる。これにより、利用者は実施すべき操作を迅速に決定することができる。この結果、作業全体の運用効率を向上することができる。
以下、本発明の作業車両の移動物体検知システムの第5の実施の形態を図面を用いて説明する。図20は本発明の作業車両の移動物体検知システムの第5の実施の形態の構成を示すブロック図、図21は本発明の作業車両の移動物体検知システムの第5の実施の形態における検知情報データベースに保持される情報の一例を示す概念図、図22は本発明の作業車両の移動物体検知システムの第5の実施の形態における移動物体検知の結果表示の前の処理の一例を説明する概念図、図23は本発明の作業車両の移動物体検知システムの第5の実施の形態における移動物体検知の結果表示の一例を示す概念図、図24は本発明の作業車両の移動物体検知システムの第5の実施の形態における移動物体検知の結果表示の前の処理の他の例を説明する概念図、図25は本発明の作業車両の移動物体検知システムの第5の実施の形態における移動物体検知の結果表示の他の例を示す概念図、図26は本発明の作業車両の移動物体検知システムの第5の実施の形態における移動物体検知の結果表示の更に他の例を示す概念図である。図20乃至図26において、図1乃至図19に示す符号と同符号のものは同一部分であるので、その詳細な説明は省略する。
本実施の形態における作業車両の移動物体検知システムは、その構成及び運用方法は第1の実施の形態と大略同様である。第5の実施の形態においては、検知結果映像603を表示する際の角度を算出する処理を行う点が第1の実施の形態と異なる。
本実施の形態における車体近傍移動物体検知装置100の構成は、図20に示すように、回転画像構築部2301が追加されている点が第1の実施の形態と異なる。回転画像構築部2301は、検知画像取得部107からの検知結果の位置を入力し、複数の検知結果の位置に対応する検知結果映像603を表示する際の角度を算出して指令を検知画像取得部107へ出力する。
次に、本実施の形態における回転画像構築部2301の処理内容を、図21乃至図23を用いて説明する。図21は本実施の形態における検知情報データベース106が保持する検知結果情報601を示す。図7に示した第1の実施の形態における検知結果情報601の項目の他に記録時の移動方向1601と現在の移動方向1602を追加して保持する。
記録時の移動方向1601とは、検知結果映像603を記録した際に、検知結果が移動している方向を示すものである。また現在の移動方向1602とは、検知結果現在位置605において、検知結果が移動している方向を示すものである。移動方向に関しては、現在の検知結果503が存在している位置と、前回の検知結果504が存在している位置の差から求めた方向ベクトルによって算出する。
次に、この検知結果情報601を用いた回転画像構築部2301の処理について説明する。図22は、検知対象を俯瞰合成映像706に表示している。ここでは、移動する車両が第1の検知位置1701に存在している時点で検知結果映像603を作成したものとする。その後、車両は自車両1の前方を左から右へ移動しながら右旋回し、自車両1へ車両の先頭を向けて、現在は第2の検知位置1702に到達している。
この場合、この車両の記録時の移動方向1601は、自車両1から見て前方の左から右への方向であり、現在の移動方向1602は、自車両1から見て前方から接近する方向である。記録時の移動方向1601から現在の移動方向1602への変化は、図22の破線に示すものであり、時計回りに90度の回転となる。
これらの情報を基に、表示装置108に移動物体検知の結果表示として表示する内容を図23に示す。現在車両が存在している第2の検知位置1702において、検知結果映像603を、時計回りに90度回転させ描画している。このことにより、検知対象の側面を表示させると共に、検知対象が現在移動している方向と、検知結果映像603の方向とを合致させて表示する。この結果、表示装置108に表示されている内容から、検知対象がどの方向へ移動しているかを容易に把握できるので、利用者がどのように対応すべきか迅速に判断することが可能となる。
上述した例は、第1の検知位置1701及び第2の検知位置1702が同一のカメラ101によって撮影した映像内に存在している状態における処理に関して説明している。第1の検知位置1701及び第2の検知位置1702が異なるカメラ101によって撮影された映像内に存在している場合について、図24と図25を用いて説明する。
図24に示す状態では、第1の検知位置1701は、変換した前方映像701内に存在し、第2の検知位置1702はこれとは異なり、変換した右方向映像704内に存在している。この場合、第1の検知位置1701が存在するカメラ101、すなわち前方カメラ301と、第2の検知位置1702が存在するカメラ101、すなわち右方向カメラ304が、水平方向になす角度θを、検知結果映像603を描画する際の方向に加算する処理を行う。
この実施の形態においては、角度θは90度である。これらの情報を基に、表示装置108に移動物体検知の結果表示として表示する内容を図25に示す。現在車両が存在している第2の検知位置1702において、検知結果映像603を、時計回りに90度回転させ描画している。
本実施の形態におけるこの処理は、図6に示した前方映像401のような、1個のカメラが撮影する映像に対しても適用可能である。図26を用いて説明する。ここで、上述した図22と図23と同様な位置関係にて第1の検知位置1701と第2の検知位置1702が存在して、それぞれの移動方向が記録時の移動方向1601及び現在の移動方向1602と同等であるとする。
この関係は、図26の上側の図に示される。回転画像構築部2301が上述と同じ処理を実行することで、表示装置108に移動物体検知の結果表示として表示する内容を図26の下側の図に示す。このような処理を行なうことで、表示装置108が俯瞰合成映像706以外の映像を表示している場合でも、利用者がどのように対応すべきか迅速に判断することが可能となる。
上述した本発明の作業車両の移動物体検知システムの第5の実施の形態によれば、上述した第1の実施の形態と同様の効果を得ることができる。
また、上述した本発明の作業車両の移動物体検知システムの第5の実施の形態によれば、検知対象の側面を表示させると共に、検知対象が現在移動している方向と、検知結果映像の方向とを合致させて表示するので、表示装置に表示されている内容から、検知対象がどの方向へ移動しているかを容易に把握できる。この結果、利用者がどのように対応すべきか迅速に判断することが可能となる。
なお、本発明の実施の形態は作業車両として大型のダンプトラックに適用した場合を例に説明したが、これに限られるものではない。鉱山などにおける大型の作業車両のいずれにも適用することができる。
なお、本発明は上記した実施例に限定されるものではなく、様々な変形例が含まれる。例えば、上記した実施例は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、上記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、上記の各構成、機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。