JP2014062387A - 作業機械用周辺監視装置 - Google Patents

作業機械用周辺監視装置 Download PDF

Info

Publication number
JP2014062387A
JP2014062387A JP2012207554A JP2012207554A JP2014062387A JP 2014062387 A JP2014062387 A JP 2014062387A JP 2012207554 A JP2012207554 A JP 2012207554A JP 2012207554 A JP2012207554 A JP 2012207554A JP 2014062387 A JP2014062387 A JP 2014062387A
Authority
JP
Japan
Prior art keywords
image
region
coordinates
object detection
detection sensor
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.)
Granted
Application number
JP2012207554A
Other languages
English (en)
Other versions
JP5960007B2 (ja
Inventor
Takeya Izumikawa
岳哉 泉川
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.)
Sumitomo SHI Construction Machinery Co Ltd
Original Assignee
Sumitomo SHI Construction Machinery Co 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 Sumitomo SHI Construction Machinery Co Ltd filed Critical Sumitomo SHI Construction Machinery Co Ltd
Priority to JP2012207554A priority Critical patent/JP5960007B2/ja
Publication of JP2014062387A publication Critical patent/JP2014062387A/ja
Application granted granted Critical
Publication of JP5960007B2 publication Critical patent/JP5960007B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Component Parts Of Construction Machinery (AREA)
  • Closed-Circuit Television Systems (AREA)

Abstract

【課題】周囲の物体の状況をより分かり易く操作者に伝えることができる作業機械用周辺監視装置を提供すること。
【解決手段】ショベル60に取り付けられるカメラ2が撮像した入力画像に基づいて出力画像を生成する画像生成装置100は、ショベル60に取り付けられ、ショベル60の周囲に存在する物体を検出する物体検出センサ6と、物体検出センサ6により物体が検出された場合に、その物体を検出した物体検出センサ6を特定し、その特定結果に応じて出力画像の所定領域を強調表示する強調表示手段12と、を備える。
【選択図】図1

Description

本発明は、被操作体に取り付けられたカメラが撮像した入力画像に基づいて出力画像を生成する作業機械用周辺監視装置に関する。
従来、ショベルの上部旋回体に取り付けられるレーザレーダを用いて、ショベルの周囲に存在する物体のショベルに対する距離及び方向を取得しながら周囲を監視する周囲監視装置が知られている(例えば、特許文献1参照。)。
この周囲監視装置は、物体のショベルに対する距離及び方向が所定時間にわたって変化しない場合にその物体を静止障害物と判定し、距離及び方向が変化する場合にその物体を移動障害物と判定する。その上で、周囲監視装置は、ショベル及びその周囲を上空から見たイラスト画像を生成し、障害物の実在位置に対応するイラスト画像上の位置にその障害物を表すイラストを表示する。また、周囲監視装置は、静止障害物と移動障害物とを異なる態様のイラストで表示する。
このようにして、周囲監視装置は、ショベルの周囲の障害物の状況を運転者に分かり易く伝えることができるようにしている。
特開2008−163719号公報
しかしながら、特許文献1に記載の周囲監視装置が提示する出力画像は、障害物の実在位置に対応するイラスト画像上の位置にその障害物を表すイラストを表示するのみであり、障害物の実画像を表示するものではないため、ショベルの周囲の障害物の状況を運転者に分かり易く伝えるには未だ不十分である。
上述の点に鑑み、本発明は、周囲の物体の状況をより分かり易く操作者に伝えることができる作業機械用周辺監視装置を提供することを目的とする。
上述の目的を達成するために、本発明の実施例に係る作業機械用周辺監視装置は、作業機械に取り付けられるカメラが撮像した入力画像に基づいて出力画像を生成する作業機械用周辺監視装置であって、前記作業機械に取り付けられ、前記作業機械の周囲に存在する物体を検出する物体検出センサと、前記物体検出センサにより物体が検出された場合に、該物体を検出した物体検出センサを特定し、該特定結果に応じて前記出力画像の所定領域を強調表示する強調表示手段と、を備える。
上述の手段により、本発明は、周囲の物体の状況をより分かり易く操作者に伝えることができる作業機械用周辺監視装置を提供することができる。
本発明の実施例に係る画像生成装置の構成例を概略的に示すブロック図である。 画像生成装置が搭載されるショベルの構成例を示す図である。 入力画像が投影される空間モデルの一例を示す図である。 空間モデルと処理対象画像平面との間の関係の一例を示す図である。 入力画像平面上の座標と空間モデル上の座標との対応付けを説明するための図である。 座標対応付け手段による座標間の対応付けを説明するための図である。 平行線群の作用を説明するための図である。 補助線群の作用を説明するための図である。 処理対象画像生成処理及び出力画像生成処理の流れを示すフローチャートである。 出力画像の表示例である。 画像生成装置が搭載されるショベルの上面図である。 ショベルに搭載された3台のカメラのそれぞれの入力画像と、それら入力画像を用いて生成される出力画像とを示す図である。 2つのカメラのそれぞれの撮像領域の重複撮像領域における物体の消失を防止する画像消失防止処理を説明するための図である。 図12で示される出力画像と、図12の出力画像に画像消失防止処理を適用することで得られる出力画像との違いを表す対比図である。 所定領域選択処理を説明する図である。 強調表示処理の流れを示すフローチャートである。 強調表示された所定領域を含む出力画像の表示例である。
以下、図面を参照しつつ、本発明を実施するための最良の形態の説明を行う。
図1は、本発明の実施例に係る画像生成装置100の構成例を概略的に示すブロック図である。
画像生成装置100は、作業機械の周辺を監視する作業機械用周辺監視装置の1例であり、制御部1、カメラ2、入力部3、記憶部4、表示部5、及び物体検出センサ6で構成される。具体的には、画像生成装置100は、作業機械に搭載されたカメラ2が撮像した入力画像に基づいて出力画像を生成しその出力画像を操作者に提示する。
図2は、画像生成装置100が搭載される作業機械としてのショベル60の構成例を示す図であり、ショベル60は、クローラ式の下部走行体61の上に、旋回機構62を介して、上部旋回体63を旋回軸PVの周りで旋回自在に搭載している。
また、上部旋回体63は、その前方左側部にキャブ(運転室)64を備え、その前方中央部に掘削アタッチメントEを備え、その右側面及び後面にカメラ2(右側方カメラ2R、後方カメラ2B)及び物体検出センサ6(右側方物体検出センサ6R、後方物体検出センサ6B)を備えている。なお、キャブ64内の操作者が視認し易い位置には表示部5が設置されている。
次に、画像生成装置100の各構成要素について説明する。
制御部1は、CPU(Central Processing Unit)、RAM(Random Access Memory)、ROM(Read Only Memory)、NVRAM(Non-Volatile Random Access Memory)等を備えたコンピュータであって、例えば、後述する座標対応付け手段10、画像生成手段11、及び強調表示手段12のそれぞれに対応するプログラムをROMやNVRAMに記憶し、一時記憶領域としてRAMを利用しながら各手段に対応する処理をCPUに実行させる。
カメラ2は、ショベル60の周囲を映し出す入力画像を取得するための装置であり、例えば、キャブ64にいる操作者の死角となる領域を撮像できるよう上部旋回体63の右側面及び後面に取り付けられる(図2参照。)、CCD(Charge Coupled Device)やCMOS(Complementary Metal Oxide Semiconductor)等の撮像素子を備えた右側方カメラ2R及び後方カメラ2Bである。なお、カメラ2は、上部旋回体63の右側面及び後面以外の位置(例えば、前面及び左側面である。)に取り付けられていてもよく、広い範囲を撮像できるよう広角レンズ又は魚眼レンズが装着されていてもよい。
また、カメラ2は、制御部1からの制御信号に応じて入力画像を取得し、取得した入力画像を制御部1に対して出力する。なお、カメラ2は、魚眼レンズ又は広角レンズを用いて入力画像を取得した場合には、それらレンズを用いることによって生じる見掛け上の歪曲やアオリを補正した補正済みの入力画像を制御部1に対して出力するが、その見掛け上の歪曲やアオリを補正していない入力画像をそのまま制御部1に対して出力してもよい。その場合には、制御部1がその見掛け上の歪曲やアオリを補正することとなる。
入力部3は、操作者が画像生成装置100に対して各種情報を入力できるようにするための装置であり、例えば、タッチパネル、ボタンスイッチ、ポインティングデバイス、キーボード等である。
記憶部4は、各種情報を記憶するための装置であり、例えば、ハードディスク、光学ディスク、又は半導体メモリ等である。
表示部5は、画像情報を表示するための装置であり、例えば、ショベル60のキャブ64(図2参照。)内に設置された液晶ディスプレイ又はプロジェクタ等であって、制御部1が出力する各種画像を表示する。
物体検出センサ6は、ショベル60の周囲に存在する物体を検出するための装置であり、例えば、キャブ64にいる操作者の死角となる領域に存在する物体を検出できるよう上部旋回体63の右側面及び後面に取り付けられる(図2参照。)。なお、物体検出センサ6は、上部旋回体63の前面、左側面、右側面、及び後面のうちの何れか1つ以上に取り付けられていてもよく、全ての面に取り付けられていてもよい。
本実施例では、物体検出センサ6は、無指向性センサであり、例えば、無指向性超音波センサ、無指向性焦電型赤外線センサ等である。具体的には、物体検出センサ6は、検出範囲全体に満遍なく超音波又は赤外光を放射し、反射波又は反射光を検出することによって検出範囲内に存在する物体を検出する。また、物体検出センサ6は、超音波又は赤外光を放射してから反射波又は反射光を検出するまでの経過時間に基づいて、検出した物体までの距離を検出してもよい。
なお、物体検出センサ6は、ショベル60の周囲に設置される漏洩同軸ケーブルであってもよい。この場合、検出範囲は、外部導体部分に形成される複数のスロットのそれぞれに対応して形成される。
また、画像生成装置100は、入力画像に基づいて処理対象画像を生成し、その処理対象画像に画像変換処理を施すことによって周囲の物体との位置関係や距離感を直感的に把握できるようにする出力画像を生成した上で、その出力画像を操作者に提示するようにしてもよい。
「処理対象画像」は、入力画像に基づいて生成される、画像変換処理(例えば、スケール変換、アフィン変換、歪曲変換、視点変換処理等である。)の対象となる画像であり、例えば、地表を上方から撮像するカメラによる入力画像であってその広い画角により水平方向の画像(例えば、空の部分である。)を含む入力画像を画像変換処理で用いる場合に、その水平方向の画像が不自然に表示されないよう(例えば、空の部分が地表にあるものとして扱われないよう)その入力画像を所定の空間モデルに投影した上で、その空間モデルに投影された投影画像を別の二次元平面に再投影することによって得られる、画像変換処理に適した画像である。なお、処理対象画像は、画像変換処理を施すことなくそのまま出力画像として用いられてもよい。
「空間モデル」は、少なくとも、処理対象画像が位置する平面である処理対象画像平面以外の平面又は曲面(例えば、処理対象画像平面に平行な平面、又は、処理対象画像平面との間で角度を形成する平面若しくは曲面である。)を含む、一又は複数の平面若しくは曲面で構成される、入力画像の投影対象である。
なお、画像生成装置100は、処理対象画像を生成することなく、その空間モデルに投影された投影画像に画像変換処理を施すことによって出力画像を生成するようにしてもよい。また、投影画像は、画像変換処理を施すことなくそのまま出力画像として用いられてもよい。
図3は、入力画像が投影される空間モデルMDの一例を示す図であり、図3(A)は、ショベル60を側方から見たときのショベル60と空間モデルMDとの間の関係を示し、図3(B)は、ショベル60を上方から見たときのショベル60と空間モデルMDとの間の関係を示す。
図3で示されるように、空間モデルMDは、半円筒形状を有し、その底面内部の平面領域R1とその側面内部の曲面領域R2とを有する。
また、図4は、空間モデルMDと処理対象画像平面との間の関係の一例を示す図であり、処理対象画像平面R3は、例えば、空間モデルMDの平面領域R1を含む平面である。なお、図4は、明確化のために、空間モデルMDを、図3で示すような半円筒形状ではなく、円筒形状で示しているが、空間モデルMDは、半円筒形状及び円筒形状の何れであってもよいものとする。以降の図においても同様である。また、処理対象画像平面R3は、上述のように、空間モデルMDの平面領域R1を含む円形領域であってもよく、空間モデルMDの平面領域R1を含まない環状領域であってもよい。
次に、制御部1が有する各種手段について説明する。
座標対応付け手段10は、カメラ2が撮像した入力画像が位置する入力画像平面上の座標と、空間モデルMD上の座標と、処理対象画像平面R3上の座標とを対応付けるための手段であり、例えば、予め設定された、或いは、入力部3を介して入力される、カメラ2の光学中心、焦点距離、CCDサイズ、光軸方向ベクトル、カメラ水平方向ベクトル、射影方式等のカメラ2に関する各種パラメータと、予め決定された、入力画像平面、空間モデルMD、及び処理対象画像平面R3の相互の位置関係とに基づいて、入力画像平面上の座標と、空間モデルMD上の座標と、処理対象画像平面R3上の座標とを対応付け、それらの対応関係を記憶部4の入力画像・空間モデル対応マップ40及び空間モデル・処理対象画像対応マップ41に記憶する。
なお、座標対応付け手段10は、処理対象画像を生成しない場合には、空間モデルMD上の座標と処理対象画像平面R3上の座標との対応付け、及び、その対応関係の空間モデル・処理対象画像対応マップ41への記憶を省略する。
画像生成手段11は、出力画像を生成するための手段であり、例えば、処理対象画像にスケール変換、アフィン変換、又は歪曲変換を施すことによって、処理対象画像平面R3上の座標と出力画像が位置する出力画像平面上の座標とを対応付け、その対応関係を記憶部4の処理対象画像・出力画像対応マップ42に記憶し、座標対応付け手段10がその値を記憶した入力画像・空間モデル対応マップ40及び空間モデル・処理対象画像対応マップ41を参照しながら、出力画像における各画素の値(例えば、輝度値、色相値、彩度値等である。)と入力画像における各画素の値とを関連付けて出力画像を生成する。
また、画像生成手段11は、予め設定された、或いは、入力部3を介して入力される、仮想カメラの光学中心、焦点距離、CCDサイズ、光軸方向ベクトル、カメラ水平方向ベクトル、射影方式等の各種パラメータに基づいて、処理対象画像平面R3上の座標と出力画像が位置する出力画像平面上の座標とを対応付け、その対応関係を記憶部4の処理対象画像・出力画像対応マップ42に記憶し、座標対応付け手段10がその値を記憶した入力画像・空間モデル対応マップ40及び空間モデル・処理対象画像対応マップ41を参照しながら、出力画像における各画素の値(例えば、輝度値、色相値、彩度値等である。)と入力画像における各画素の値とを関連付けて出力画像を生成する。
なお、画像生成手段11は、仮想カメラの概念を用いることなく、処理対象画像のスケールを変更して出力画像を生成するようにしてもよい。
また、画像生成手段11は、処理対象画像を生成しない場合には、施した画像変換処理に応じて空間モデルMD上の座標と出力画像平面上の座標とを対応付け、入力画像・空間モデル対応マップ40を参照しながら、出力画像における各画素の値(例えば、輝度値、色相値、彩度値等である。)と入力画像における各画素の値とを関連付けて出力画像を生成する。この場合、画像生成手段11は、処理対象画像平面R3上の座標と出力画像平面上の座標との対応付け、及び、その対応関係の処理対象画像・出力画像対応マップ42への記憶を省略する。
強調表示手段12は、出力画像の所定領域を強調表示するための手段である。本実施例では、強調表示手段12は、物体検出センサ6により物体が検出された場合に、その物体を検出した物体検出センサ6を特定し、その特定結果に応じて出力画像の所定領域を強調表示する。
「所定領域」は、出力画像上における予め設定された1又は複数の領域であり、例えば、物体検出センサ6の検出範囲に基づいて設定される領域である。本実施例では、複数の所定領域のそれぞれが、複数の物体検出センサ6のそれぞれの検出範囲に基づいて設定される。例えば、複数の所定領域のうちの1つは、隣り合う2つの物体検出センサ6のそれぞれの検出範囲の重複部分に対応する。また、複数の所定領域のうちの別の1つは、複数の物体検出センサ6のうちの特定の1つの検出範囲に対応する。また、複数の所定領域のうちのさらに別の1つは、隣り合う2つの物体検出センサ6の一方の検出範囲からそれら2つの物体検出センサ6のそれぞれの検出範囲の重複部分を差し引いた領域に対応する。
また、所定領域は、出力画像がショベル60の周辺を俯瞰する視点変換画像である場合、ショベル60の位置を中心として放射状に広がる扇形領域として設定される。
また、本実施例では、強調表示手段12は、複数の物体検出センサ6のそれぞれの出力に基づいて、何れの物体検出センサ6によって物体が検出されたかを特定する。
そして、強調表示手段12は、その特定結果に応じて、1又は複数の所定領域のうちから、強調表示すべき1又は複数の所定領域を選択する。具体的には、強調表示手段12は、物体を検出した物体検出センサ6の組み合わせに応じて、強調表示すべき1又は複数の所定領域を選択する。例えば、強調表示手段12は、物体を検出した物体検出センサ6の組み合わせに対応付けてROM等に予め記憶された所定領域の識別番号を読み出すことによって、強調表示すべき1又は複数の所定領域を選択する。
そして、強調表示手段12は、選択した1又は複数の所定領域を強調表示する。本実施例では、強調表示手段12は、選択された所定領域の輪郭を出力画像上に重畳表示する。また、強調表示手段12は、選択された所定領域に対応する位置に警告マークを表示してもよい。或いは、強調表示手段12は、選択された所定領域全体の輝度及び色調の少なくとも1つを、選択されていない所定領域と異ならせてもよい。
次に、座標対応付け手段10及び画像生成手段11による具体的な処理の一例について説明する。
座標対応付け手段10は、例えば、ハミルトンの四元数を用いて、入力画像平面上の座標と空間モデル上の座標とを対応付けることができる。
図5は、入力画像平面上の座標と空間モデル上の座標との対応付けを説明するための図であり、カメラ2の入力画像平面は、カメラ2の光学中心Cを原点とするUVW直交座標系における一平面として表され、空間モデルは、XYZ直交座標系における立体面として表されるものとする。
最初に、座標対応付け手段10は、空間モデル上の座標(XYZ座標系上の座標)を入力画像平面上の座標(UVW座標系上の座標)に変換するため、XYZ座標系の原点を光学中心C(UVW座標系の原点)に並行移動させた上で、X軸をU軸に、Y軸をV軸に、Z軸を−W軸(符号「−」は方向が逆であることを意味する。これは、UVW座標系がカメラ前方を+W方向とし、XYZ座標系が鉛直下方を−Z方向としていることに起因する。)にそれぞれ一致させるようXYZ座標系を回転させる。
なお、カメラ2が複数存在する場合、カメラ2のそれぞれが個別のUVW座標系を有することとなるので、座標対応付け手段10は、複数のUVW座標系のそれぞれに対して、XYZ座標系を並行移動させ且つ回転させることとなる。
上述の変換は、カメラ2の光学中心CがXYZ座標系の原点となるようにXYZ座標系を並行移動させた後に、Z軸が−W軸に一致するよう回転させ、更に、X軸がU軸に一致するよう回転させることによって実現されるので、座標対応付け手段10は、この変換をハミルトンの四元数で記述することにより、それら二回の回転を一回の回転演算に纏めることができる。
ところで、あるベクトルAを別のベクトルBに一致させるための回転は、ベクトルAとベクトルBとが張る面の法線を軸としてベクトルAとベクトルBとが形成する角度だけ回転させる処理に相当し、その角度をθとすると、ベクトルAとベクトルBとの内積から、角度θは、
で表されることとなる。
また、ベクトルAとベクトルBとが張る面の法線の単位ベクトルNは、ベクトルAとベクトルBとの外積から
で表されることとなる。
なお、四元数は、i、j、kをそれぞれ虚数単位とした場合、
を満たす超複素数であり、本実施例において、四元数Qは、実成分をt、純虚成分をa、b、cとして、
で表されるものとし、四元数Qの共役四元数は、
で表されるものとする。
四元数Qは、実成分tを0(ゼロ)としながら、純虚成分a、b、cで三次元ベクトル(a,b,c)を表現することができ、また、t、a、b、cの各成分により任意のベクトルを軸とした回転動作を表現することもできる。
更に、四元数Qは、連続する複数回の回転動作を統合して一回の回転動作として表現することができ、例えば、任意の点S(sx,sy,sz)を、任意の単位ベクトルC(l,m,n)を軸としながら角度θだけ回転させたときの点D(ex,ey,ez)を以下のように表現することができる。
ここで、本実施例において、Z軸を−W軸に一致させる回転を表す四元数をQzとすると、XYZ座標系におけるX軸上の点Xは、点X'に移動させられるので、点X'は、
で表されることとなる。
また、本実施例において、X軸上にある点X'と原点とを結ぶ線をU軸に一致させる回転を表す四元数をQxとすると、「Z軸を−W軸に一致させ、更に、X軸をU軸に一致させる回転」を表す四元数Rは、
で表されることとなる。
以上により、空間モデル(XYZ座標系)上の任意の座標Pを入力画像平面(UVW座標系)上の座標で表現したときの座標P'は、
で表されることとなり、四元数Rがカメラ2のそれぞれで不変であることから、座標対応付け手段10は、以後、この演算を実行するだけで空間モデル(XYZ座標系)上の座標を入力画像平面(UVW座標系)上の座標に変換することができる。
空間モデル(XYZ座標系)上の座標を入力画像平面(UVW座標系)上の座標に変換した後、座標対応付け手段10は、カメラ2の光学中心C(UVW座標系上の座標)と空間モデル上の任意の座標PをUVW座標系で表した座標P'とを結ぶ線分CP'と、カメラ2の光軸Gとが形成する入射角αを算出する。
また、座標対応付け手段10は、カメラ2の入力画像平面R4(例えば、CCD面)に平行で且つ座標P'を含む平面Hにおける、平面Hと光軸Gとの交点Eと座標P'とを結ぶ線分EP'と、平面HにおけるU'軸とが形成する偏角φ、及び線分EP'の長さを算出する。
カメラの光学系は、通常、像高さhが入射角α及び焦点距離fの関数となっているので、座標対応付け手段10は、通常射影(h=ftanα)、正射影(h=fsinα)、立体射影(h=2ftan(α/2))、等立体角射影(h=2fsin(α/2))、等距離射影(h=fα)等の適切な射影方式を選択して像高さhを算出する。
その後、座標対応付け手段10は、算出した像高さhを偏角φによりUV座標系上のU成分及びV成分に分解し、入力画像平面R4の一画素当たりの画素サイズに相当する数値で除算することにより、空間モデルMD上の座標P(P')と入力画像平面R4上の座標とを対応付けることができる。
なお、入力画像平面R4のU軸方向における一画素当たりの画素サイズをaUとし、入力画像平面R4のV軸方向における一画素当たりの画素サイズをaVとすると、空間モデルMD上の座標P(P')に対応する入力画像平面R4上の座標(u,v)は、
で表されることとなる。
このようにして、座標対応付け手段10は、空間モデルMD上の座標と、カメラ毎に存在する一又は複数の入力画像平面R4上の座標とを対応付け、空間モデルMD上の座標、カメラ識別子、及び入力画像平面R4上の座標を関連付けて入力画像・空間モデル対応マップ40に記憶する。
また、座標対応付け手段10は、四元数を用いて座標の変換を演算するので、オイラー角を用いて座標の変換を演算する場合と異なり、ジンバルロックを発生させることがないという利点を有する。しかしながら、座標対応付け手段10は、四元数を用いて座標の変換を演算するものに限定されることはなく、オイラー角を用いて座標の変換を演算するようにしてもよい。
なお、複数の入力画像平面R4上の座標への対応付けが可能な場合、座標対応付け手段10は、空間モデルMD上の座標P(P')を、その入射角αが最も小さいカメラに関する入力画像平面R4上の座標に対応付けるようにしてもよく、操作者が選択した入力画像平面R4上の座標に対応付けるようにしてもよい。
次に、空間モデルMD上の座標のうち、曲面領域R2上の座標(Z軸方向の成分を持つ座標)を、XY平面上にある処理対象画像平面R3に再投影する処理について説明する。
図6は、座標対応付け手段10による座標間の対応付けを説明するための図であり、図6(A)は、一例として通常射影(h=ftanα)を採用するカメラ2の入力画像平面R4上の座標と空間モデルMD上の座標との間の対応関係を示す図であって、座標対応付け手段10は、カメラ2の入力画像平面R4上の座標とその座標に対応する空間モデルMD上の座標とを結ぶ線分のそれぞれがカメラ2の光学中心Cを通過するようにして、両座標を対応付ける。
図6(A)の例では、座標対応付け手段10は、カメラ2の入力画像平面R4上の座標K1を空間モデルMDの平面領域R1上の座標L1に対応付け、カメラ2の入力画像平面R4上の座標K2を空間モデルMDの曲面領域R2上の座標L2に対応付ける。このとき、線分K1−L1及び線分K2−L2は共にカメラ2の光学中心Cを通過する。
なお、カメラ2が通常射影以外の射影方式(例えば、正射影、立体射影、等立体角射影、等距離射影等である。)を採用する場合、座標対応付け手段10は、それぞれの射影方式に応じて、カメラ2の入力画像平面R4上の座標K1、K2を空間モデルMD上の座標L1、L2に対応付けるようにする。
具体的には、座標対応付け手段10は、所定の関数(例えば、正射影(h=fsinα)、立体射影(h=2ftan(α/2))、等立体角射影(h=2fsin(α/2))、等距離射影(h=fα)等である。)に基づいて、入力画像平面上の座標と空間モデルMD上の座標とを対応付ける。この場合、線分K1−L1及び線分K2−L2がカメラ2の光学中心Cを通過することはない。
図6(B)は、空間モデルMDの曲面領域R2上の座標と処理対象画像平面R3上の座標との間の対応関係を示す図であり、座標対応付け手段10は、XZ平面上に位置する平行線群PLであって、処理対象画像平面R3との間で角度βを形成する平行線群PLを導入し、空間モデルMDの曲面領域R2上の座標とその座標に対応する処理対象画像平面R3上の座標とが共に平行線群PLのうちの一つに乗るようにして、両座標を対応付ける。
図6(B)の例では、座標対応付け手段10は、空間モデルMDの曲面領域R2上の座標L2と処理対象画像平面R3上の座標M2とが共通の平行線に乗るとして、両座標を対応付けるようにする。
なお、座標対応付け手段10は、空間モデルMDの平面領域R1上の座標を曲面領域R2上の座標と同様に平行線群PLを用いて処理対象画像平面R3上の座標に対応付けることが可能であるが、図6(B)の例では、平面領域R1と処理対象画像平面R3とが共通の平面となっているので、空間モデルMDの平面領域R1上の座標L1と処理対象画像平面R3上の座標M1とは同じ座標値を有するものとなっている。
このようにして、座標対応付け手段10は、空間モデルMD上の座標と、処理対象画像平面R3上の座標とを対応付け、空間モデルMD上の座標及び処理対象画像R3上の座標を関連付けて空間モデル・処理対象画像対応マップ41に記憶する。
図6(C)は、処理対象画像平面R3上の座標と一例として通常射影(h=ftanα)を採用する仮想カメラ2Vの出力画像平面R5上の座標との間の対応関係を示す図であり、画像生成手段11は、仮想カメラ2Vの出力画像平面R5上の座標とその座標に対応する処理対象画像平面R3上の座標とを結ぶ線分のそれぞれが仮想カメラ2Vの光学中心CVを通過するようにして、両座標を対応付ける。
図6(C)の例では、画像生成手段11は、仮想カメラ2Vの出力画像平面R5上の座標N1を処理対象画像平面R3(空間モデルMDの平面領域R1)上の座標M1に対応付け、仮想カメラ2Vの出力画像平面R5上の座標N2を処理対象画像平面R3上の座標M2に対応付ける。このとき、線分M1−N1及び線分M2−N2は共に仮想カメラ2Vの光学中心CVを通過する。
なお、仮想カメラ2Vが通常射影以外の射影方式(例えば、正射影、立体射影、等立体角射影、等距離射影等である。)を採用する場合、画像生成手段11は、それぞれの射影方式に応じて、仮想カメラ2Vの出力画像平面R5上の座標N1、N2を処理対象画像平面R3上の座標M1、M2に対応付けるようにする。
具体的には、画像生成手段11は、所定の関数(例えば、正射影(h=fsinα)、立体射影(h=2ftan(α/2))、等立体角射影(h=2fsin(α/2))、等距離射影(h=fα)等である。)に基づいて、出力画像平面R5上の座標と処理対象画像平面R3上の座標とを対応付ける。この場合、線分M1−N1及び線分M2−N2が仮想カメラ2Vの光学中心CVを通過することはない。
このようにして、画像生成手段11は、出力画像平面R5上の座標と、処理対象画像平面R3上の座標とを対応付け、出力画像平面R5上の座標及び処理対象画像R3上の座標を関連付けて処理対象画像・出力画像対応マップ42に記憶し、座標対応付け手段10が記憶した入力画像・空間モデル対応マップ40及び空間モデル・処理対象画像対応マップ41を参照しながら、出力画像における各画素の値と入力画像における各画素の値とを関連付けて出力画像を生成する。
なお、図6(D)は、図6(A)〜図6(C)を組み合わせた図であり、カメラ2、仮想カメラ2V、空間モデルMDの平面領域R1及び曲面領域R2、並びに、処理対象画像平面R3の相互の位置関係を示す。
次に、図7を参照しながら、空間モデルMD上の座標と処理対象画像平面R3上の座標とを対応付けるために座標対応付け手段10が導入する平行線群PLの作用について説明する。
図7(A)は、XZ平面上に位置する平行線群PLと処理対象画像平面R3との間で角度βが形成される場合の図であり、図7(B)は、XZ平面上に位置する平行線群PLと処理対象画像平面R3との間で角度β1(β1>β)が形成される場合の図である。また、図7(A)及び図7(B)における空間モデルMDの曲面領域R2上の座標La〜Ldのそれぞれは、処理対象画像平面R3上の座標Ma〜Mdのそれぞれに対応するものとし、図7(A)における座標La〜Ldのそれぞれの間隔は、図7(B)における座標La〜Ldのそれぞれの間隔と等しいものとする。なお、平行線群PLは、説明目的のためにXZ平面上に存在するものとしているが、実際には、Z軸上の全ての点から処理対象画像平面R3に向かって放射状に延びるように存在するものとする。なお、この場合のZ軸を「再投影軸」と称することとする。
図7(A)及び図7(B)で示されるように、処理対象画像平面R3上の座標Ma〜Mdのそれぞれの間隔は、平行線群PLと処理対象画像平面R3との間の角度が増大するにつれて線形的に減少する(空間モデルMDの曲面領域R2と座標Ma〜Mdのそれぞれとの間の距離とは関係なく一様に減少する。)。一方で、空間モデルMDの平面領域R1上の座標群は、図7の例では、処理対象画像平面R3上の座標群への変換が行われないので、座標群の間隔が変化することはない。
これら座標群の間隔の変化は、出力画像平面R5(図6参照。)上の画像部分のうち、空間モデルMDの曲面領域R2に投影された画像に対応する画像部分のみが線形的に拡大或いは縮小されることを意味する。
次に、図8を参照しながら、空間モデルMD上の座標と処理対象画像平面R3上の座標とを対応付けるために座標対応付け手段10が導入する平行線群PLの代替例について説明する。
図8(A)は、XZ平面上に位置する補助線群ALの全てがZ軸上の始点T1から処理対象画像平面R3に向かって延びる場合の図であり、図8(B)は、補助線群ALの全てがZ軸上の始点T2(T2>T1)から処理対象画像平面R3に向かって延びる場合の図である。また、図8(A)及び図8(B)における空間モデルMDの曲面領域R2上の座標La〜Ldのそれぞれは、処理対象画像平面R3上の座標Ma〜Mdのそれぞれに対応するものとし(図8(A)の例では、座標Mc、Mdは、処理対象画像平面R3の領域外となるため図示されていない。)、図8(A)における座標La〜Ldのそれぞれの間隔は、図8(B)における座標La〜Ldのそれぞれの間隔と等しいものとする。なお、補助線群ALは、説明目的のためにXZ平面上に存在するものとしているが、実際には、Z軸上の任意の一点から処理対象画像平面R3に向かって放射状に延びるように存在するものとする。なお、図7と同様、この場合のZ軸を「再投影軸」と称することとする。
図8(A)及び図8(B)で示されるように、処理対象画像平面R3上の座標Ma〜Mdのそれぞれの間隔は、補助線群ALの始点と原点Oとの間の距離(高さ)が増大するにつれて非線形的に減少する(空間モデルMDの曲面領域R2と座標Ma〜Mdのそれぞれとの間の距離が大きいほど、それぞれの間隔の減少幅が大きくなる。)。一方で、空間モデルMDの平面領域R1上の座標群は、図8の例では、処理対象画像平面R3上の座標群への変換が行われないので、座標群の間隔が変化することはない。
これら座標群の間隔の変化は、平行線群PLのときと同様、出力画像平面R5(図6参照。)上の画像部分のうち、空間モデルMDの曲面領域R2に投影された画像に対応する画像部分のみが非線形的に拡大或いは縮小されることを意味する。
このようにして、画像生成装置100は、空間モデルMDの平面領域R1に投影された画像に対応する出力画像の画像部分(例えば、路面画像である。)に影響を与えることなく、空間モデルMDの曲面領域R2に投影された画像に対応する出力画像の画像部分(例えば、水平画像である。)を線形的に或いは非線形的に拡大或いは縮小させることができるので、ショベル60の近傍の路面画像(ショベル60を真上から見たときの仮想画像)に影響を与えることなく、ショベル60の周囲に位置する物体(ショベル60から水平方向に周囲を見たときの画像における物体)を迅速且つ柔軟に拡大或いは縮小させることができ、ショベル60の死角領域の視認性を向上させることができる。
次に、図9を参照しながら、画像生成装置100が処理対象画像を生成する処理(以下、「処理対象画像生成処理」とする。)、及び、生成した処理対象画像を用いて出力画像を生成する処理(以下、「出力画像生成処理」とする。)について説明する。なお、図9は、処理対象画像生成処理(ステップS1〜ステップS3)及び出力画像生成処理(ステップS4〜ステップS6)の流れを示すフローチャートである。また、カメラ2(入力画像平面R4)、空間モデル(平面領域R1及び曲面領域R2)、並びに、処理対象画像平面R3の配置は予め決定されているものとする。
最初に、制御部1は、座標対応付け手段10により、処理対象画像平面R3上の座標と空間モデルMD上の座標とを対応付ける(ステップS1)。
具体的には、座標対応付け手段10は、平行線群PLと処理対象画像平面R3との間に形成される角度を取得し、処理対象画像平面R3上の一座標から延びる平行線群PLの一つが空間モデルMDの曲面領域R2と交差する点を算出し、算出した点に対応する曲面領域R2上の座標を、処理対象画像平面R3上のその一座標に対応する曲面領域R2上の一座標として導き出し、その対応関係を空間モデル・処理対象画像対応マップ41に記憶する。なお、平行線群PLと処理対象画像平面R3との間に形成される角度は、記憶部4等に予め記憶された値であってもよく、入力部3を介して操作者が動的に入力する値であってもよい。
また、座標対応付け手段10は、処理対象画像平面R3上の一座標が空間モデルMDの平面領域R1上の一座標と一致する場合には、平面領域R1上のその一座標を、処理対象画像平面R3上のその一座標に対応する一座標として導き出し、その対応関係を空間モデル・処理対象画像対応マップ41に記憶する。
その後、制御部1は、座標対応付け手段10により、上述の処理によって導き出された空間モデルMD上の一座標と入力画像平面R4上の座標とを対応付ける(ステップS2)。
具体的には、座標対応付け手段10は、通常射影(h=ftanα)を採用するカメラ2の光学中心Cの座標を取得し、空間モデルMD上の一座標から延びる線分であり、光学中心Cを通過する線分が入力画像平面R4と交差する点を算出し、算出した点に対応する入力画像平面R4上の座標を、空間モデルMD上のその一座標に対応する入力画像平面R4上の一座標として導き出し、その対応関係を入力画像・空間モデル対応マップ40に記憶する。
その後、制御部1は、処理対象画像平面R3上の全ての座標を空間モデルMD上の座標及び入力画像平面R4上の座標に対応付けたか否かを判定し(ステップS3)、未だ全ての座標を対応付けていないと判定した場合には(ステップS3のNO)、ステップS1及びステップS2の処理を繰り返すようにする。
一方、制御部1は、全ての座標を対応付けたと判定した場合には(ステップS3のYES)、処理対象画像生成処理を終了させた上で出力画像生成処理を開始させ、画像生成手段11により、処理対象画像平面R3上の座標と出力画像平面R5上の座標とを対応付ける(ステップS4)。
具体的には、画像生成手段11は、処理対象画像にスケール変換、アフィン変換、又は歪曲変換を施すことによって出力画像を生成し、施したスケール変換、アフィン変換、又は歪曲変換の内容によって定まる、処理対象画像平面R3上の座標と出力画像平面R5上の座標との間の対応関係を処理対象画像・出力画像対応マップ42に記憶する。
或いは、画像生成手段11は、仮想カメラ2Vを用いて出力画像を生成する場合には、採用した射影方式に応じて処理対象画像平面R3上の座標から出力画像平面R5上の座標を算出し、その対応関係を処理対象画像・出力画像対応マップ42に記憶するようにしてもよい。
或いは、画像生成手段11は、通常射影(h=ftanα)を採用する仮想カメラ2Vを用いて出力画像を生成する場合には、その仮想カメラ2Vの光学中心CVの座標を取得した上で、出力画像平面R5上の一座標から延びる線分であり、光学中心CVを通過する線分が処理対象画像平面R3と交差する点を算出し、算出した点に対応する処理対象画像平面R3上の座標を、出力画像平面R5上のその一座標に対応する処理対象画像平面R3上の一座標として導き出し、その対応関係を処理対象画像・出力画像対応マップ42に記憶するようにしてもよい。
その後、制御部1は、画像生成手段11により、入力画像・空間モデル対応マップ40、空間モデル・処理対象画像対応マップ41、及び処理対象画像・出力画像対応マップ42を参照しながら入力画像平面R4上の座標と空間モデルMD上の座標との対応関係、空間モデルMD上の座標と処理対象画像平面R3上の座標との対応関係、及び処理対象画像平面R3上の座標と出力画像平面R5上の座標との対応関係を辿り、出力画像平面R5上の各座標に対応する入力画像平面R4上の座標が有する値(例えば、輝度値、色相値、彩度値等である。)を取得し、その取得した値を、対応する出力画像平面R5上の各座標の値として採用する(ステップS5)。なお、出力画像平面R5上の一座標に対して複数の入力画像平面R4上の複数の座標が対応する場合、画像生成手段11は、それら複数の入力画像平面R4上の複数の座標のそれぞれの値に基づく統計値(例えば、平均値、最大値、最小値、中間値等である。)を導き出し、出力画像平面R5上のその一座標の値としてその統計値を採用するようにしてもよい。
その後、制御部1は、出力画像平面R5上の全ての座標の値を入力画像平面R4上の座標の値に対応付けたか否かを判定し(ステップS6)、未だ全ての座標の値を対応付けていないと判定した場合には(ステップS6のNO)、ステップS4及びステップS5の処理を繰り返すようにする。
一方、制御部1は、全ての座標の値を対応付けたと判定した場合には(ステップS6のYES)、出力画像を生成して、この一連の処理を終了させる。
なお、画像生成装置100は、処理対象画像を生成しない場合には、処理対象画像生成処理を省略し、出力画像生成処理におけるステップS4の"処理対象画像平面上の座標"を"空間モデル上の座標"で読み替えるものとする。
以上の構成により、画像生成装置100は、ショベル60の周囲の物体とショベル60との位置関係を操作者に直感的に把握させることが可能な処理対象画像及び出力画像を生成することができる。
また、画像生成装置100は、処理対象画像平面R3から空間モデルMDを経て入力画像平面R4に遡るように座標の対応付けを実行することにより、処理対象画像平面R3上の各座標を入力画像平面R4上の一又は複数の座標に確実に対応させることができ、入力画像平面R4から空間モデルMDを経て処理対象画像平面R3に至る順番で座標の対応付けを実行する場合と比べ(この場合には、入力画像平面R4上の各座標を処理対象画像平面R3上の一又は複数の座標に確実に対応させることができるが、処理対象画像平面R3上の座標の一部が、入力画像平面R4上の何れの座標にも対応付けられない場合があり、その場合にはそれら処理対象画像平面R3上の座標の一部に補間処理等を施す必要がある。)、より良質な処理対象画像を迅速に生成することができる。
また、画像生成装置100は、空間モデルMDの曲面領域R2に対応する画像のみを拡大或いは縮小する場合には、平行線群PLと処理対象画像平面R3との間に形成される角度を変更して空間モデル・処理対象画像対応マップ41における曲面領域R2に関連する部分のみを書き換えるだけで、入力画像・空間モデル対応マップ40の内容を書き換えることなく、所望の拡大或いは縮小を実現させることができる。
また、画像生成装置100は、出力画像の見え方を変更する場合には、スケール変換、アフィン変換又は歪曲変換に関する各種パラメータの値を変更して処理対象画像・出力画像対応マップ42を書き換えるだけで、入力画像・空間モデル対応マップ40及び空間モデル・処理対象画像対応マップ41の内容を書き換えることなく、所望の出力画像(スケール変換画像、アフィン変換画像又は歪曲変換画像)を生成することができる。
同様に、画像生成装置100は、出力画像の視点を変更する場合には、仮想カメラ2Vの各種パラメータの値を変更して処理対象画像・出力画像対応マップ42を書き換えるだけで、入力画像・空間モデル対応マップ40及び空間モデル・処理対象画像対応マップ41の内容を書き換えることなく、所望の視点から見た出力画像(視点変換画像)を生成することができる。
図10は、ショベル60に搭載された二台のカメラ2(右側方カメラ2R及び後方カメラ2B)の入力画像を用いて生成される出力画像を表示部5に表示させたときの表示例である。
画像生成装置100は、それら二台のカメラ2のそれぞれの入力画像を空間モデルMDの平面領域R1及び曲面領域R2上に投影した上で処理対象画像平面R3に再投影して処理対象画像を生成し、その生成した処理対象画像に画像変換処理(例えば、スケール変換、アフィン変換、歪曲変換、視点変換処理等である。)を施すことによって出力画像を生成して、ショベル60の近傍を上空から見下ろした画像(平面領域R1における画像)と、ショベル60から水平方向に周囲を見た画像(処理対象画像平面R3における画像)とを同時に表示している。
なお、出力画像は、画像生成装置100が処理対象画像を生成しない場合には、空間モデルMDに投影された画像に画像変換処理(例えば、視点変換処理である。)を施すことによって生成されるものとする。
また、出力画像は、ショベル60が旋回動作を行う際の画像を違和感なく表示できるよう、円形にトリミングされ、その円の中心CTRが空間モデルMDの円筒中心軸上で、且つ、ショベル60の旋回軸PV上となるように生成されており、ショベル60の旋回動作に応じてその中心CTRを軸に回転するように表示される。この場合、空間モデルMDの円筒中心軸は、再投影軸と一致するものであってもよく、一致しないものであってもよい。
なお、空間モデルMDの半径は、例えば、5メートルであり、平行線群PLが処理対象画像平面R3との間で形成する角度、又は、補助線群ALの始点高さは、ショベル60の旋回中心から掘削アタッチメントEの最大到達距離(例えば12メートルである。)だけ離れた位置に物体(例えば、作業員である。)が存在する場合にその物体が表示部5で十分大きく(例えば、7ミリメートル以上である。)表示されるように、設定され得る。
更に、出力画像は、ショベル60のCG画像を、ショベル60の前方が表示部5の画面上方と一致し、且つ、その旋回中心が中心CTRと一致するように配置するようにしてもよい。ショベル60と出力画像に現れる物体との間の位置関係をより分かり易くするためである。なお、出力画像は、方位等の各種情報を含む額縁画像をその周囲に配置するようにしてもよい。
次に、図11〜図14を参照しながら、画像生成装置100が生成する出力画像の別の例について説明する。
図11は、画像生成装置100を搭載するショベル60の上面図である。図11に示す実施例では、ショベル60は、3台のカメラ2と、3台のカメラ2のそれぞれの左右両側に設置される合計6台の物体検出センサ6とを備える。3台のカメラ2は、左側方カメラ2L、右側方カメラ2R、及び後方カメラ2Bを含む。6台の物体検出センサ6は、第1左側方物体検出センサ6L1、第2左側方物体検出センサ6L2、第1右側方物体検出センサ6R1、第2右側方物体検出センサ6R2、第1後方物体検出センサ6B1、及び第2後方物体検出センサ6B2を含む。なお、図11の一点鎖線で示す領域CL、CR、CBは、それぞれ、左側方カメラ2L、右側方カメラ2R、後方カメラ2Bの撮像領域を示す。また、図11の太い点線で示す領域ZL1、ZR1、ZB1は、それぞれ、第1左側方物体検出センサ6L1、第1後方物体検出センサ6B1、第1右側方物体検出センサ6R1の検出範囲を示す。また、図11の細い点線で示す領域ZL2、ZR2、ZB2は、それぞれ、第2左側方物体検出センサ6L2、第2後方物体検出センサ6B2、第2右側方物体検出センサ6R2の検出範囲を示す。
なお、本実施例では、領域ZL1、ZB1、ZR1及び領域ZL2、ZB2、ZR2の形状は、ショベル60の旋回軸を中心とする円の一部を構成する扇形であり、同じ大きさを有する。但し、領域ZL1、ZL2、ZB1、ZB2、ZR1、ZR2は、それぞれ異なる形状及び大きさを有していてもよい。例えば、領域ZL1、ZL2、ZB1、ZB2、ZR1、ZR2は、それぞれ異なる扇形の中心角を有していてもよい。所定領域が小さい程、物体の存在が推定される領域をより高精度に絞り込むことができるためである。この場合、物体検出センサ6の数、設置位置、検出領域は、各所定領域の所望の形状及び大きさに応じて設定される。
また、図11では、図の明瞭化のため、領域ZL1、ZB1、ZR1と領域ZL2、ZB2、ZR2とが半径方向に僅かにずれているが、このずれは必須ではない。
また、本実施例では、図11に示すように、物体検出センサ6の検出範囲がカメラ2の撮像領域よりも狭いが、カメラ2の撮像領域と同じでもよく、カメラ2の撮像領域より広くてもよい。また、本実施例では、図11に示すように、物体検出センサ6の検出範囲は、カメラ2の撮像領域内において、ショベル60の近傍に位置するが、ショベル60からより遠い領域にあってもよい。
また、本実施例では、図11に示すように、領域ZL1、ZB1、ZR1は、互いに重複しないように隣接して配置される。同様に、領域ZL2、ZB2、ZR2も、互いに重複しないように隣接して配置される。一方で、領域ZL1と領域ZL2とは互いに一部が重複するように配置される。領域ZB1と領域ZB2との重複関係、及び、領域ZR1と領域ZR2との重複関係についても同様である。但し、領域ZL1、ZL2、ZB1、ZB2、ZR1、ZR2は、互いに重複しないように配置されてもよい。
図12は、ショベル60に搭載された3台のカメラ2のそれぞれの入力画像と、それら入力画像を用いて生成される出力画像とを示す図である。
画像生成装置100は、3台のカメラ2のそれぞれの入力画像を空間モデルMDの平面領域R1及び曲面領域R2上に投影した上で処理対象画像平面R3に再投影して処理対象画像を生成する。また、画像生成装置100は、生成した処理対象画像に画像変換処理(例えば、スケール変換、アフィン変換、歪曲変換、視点変換処理等である。)を施すことによって出力画像を生成する。その結果、画像生成装置100は、ショベル60の近傍を上空から見下ろした画像(平面領域R1における画像)と、ショベル60から水平方向に周囲を見た画像(処理対象画像平面R3における画像)とを同時に表示する。なお、出力画像の中央に表示される画像は、ショベル60のCG画像60CGである。
図12において、右側方カメラ2Rの入力画像、及び、後方カメラ2Bの入力画像はそれぞれ、右側方カメラ2Rの撮像領域と後方カメラ2Bの撮像領域との重複撮像領域内に人物を捉えている(右側方カメラ2Rの入力画像における二点鎖線で囲まれる領域R10、及び、後方カメラ2Bの入力画像における二点鎖線で囲まれる領域R11参照。)。
しかしながら、出力画像平面上の座標が入射角の最も小さいカメラに関する入力画像平面上の座標に対応付けられるものとすると、出力画像は、重複撮像領域内の人物を消失させてしまう(出力画像内の一点鎖線で囲まれる領域R12参照。)。
そこで、画像生成装置100は、重複撮像領域に対応する出力画像部分において、後方カメラ2Bの入力画像平面上の座標が対応付けられる領域と、右側方カメラ2Rの入力画像平面上の座標が対応付けられる領域とを混在させ、重複撮像領域内の物体が消失するのを防止する。
図13は、2つのカメラのそれぞれの撮像領域の重複撮像領域における物体の消失を防止する画像消失防止処理を説明するための図である。
図13(A)は、右側方カメラ2Rの撮像領域と後方カメラ2Bの撮像領域との重複撮像領域に対応する出力画像部分を示す図であり、図12の点線で示す矩形領域R13に対応する。
また、図13(A)において、灰色で塗り潰された領域PR1は、後方カメラ2Bの入力画像部分が配置される画像領域であり、領域PR1に対応する出力画像平面上の各座標には後方カメラ2Bの入力画像平面上の座標が対応付けられる。
一方、白色で塗り潰された領域PR2は、右側方カメラ2Rの入力画像部分が配置される画像領域であり、部分PR2に対応する出力画像平面上の各座標には右側方カメラ2Rの入力画像平面上の座標が対応付けられる。
本実施例では、領域PR1と領域PR2とが縞模様を形成するように配置され、領域PR1と領域PR2とが縞状に交互に並ぶ部分の境界線は、ショベル60の旋回中心を中心とする水平面上の同心円によって定められる。
図13(B)は、ショベル60の右斜め後方の空間領域の状況を示す上面図であり、後方カメラ2B及び右側方カメラ2Rの双方によって撮像される空間領域の現在の状況を示す。また、図13(B)は、ショベル60の右斜め後方に棒状の立体物OBが存在することを示す。
図13(C)は、図13(B)が示す空間領域を後方カメラ2B及び右側方カメラ2Rで実際に撮像して得られた入力画像に基づいて生成される出力画像の一部を示す。
具体的には、画像OB1は、後方カメラ2Bの入力画像における立体物OBの画像が、路面画像を生成するための視点変換によって、後方カメラ2Bと立体物OBとを結ぶ線の延長方向に伸長されたものを表す。すなわち、画像OB1は、後方カメラ2Bの入力画像を用いて出力画像部分における路面画像を生成した場合に表示される立体物OBの画像の一部である。
また、画像OB2は、右後方カメラ2Rの入力画像における立体物OBの画像が、路面画像を生成するための視点変換によって、右側方カメラ2Rと立体物OBとを結ぶ線の延長方向に伸長されたものを表す。すなわち、画像OB2は、右側方カメラ2Rの入力画像を用いて出力画像部分における路面画像を生成した場合に表示される立体物OBの画像の一部である。
このように、画像生成装置100は、重複撮像領域において、後方カメラ2Bの入力画像平面上の座標が対応付けられる領域PR1と、右側方カメラ2Rの入力画像平面上の座標が対応付けられる領域PR2とを混在させる。その結果、画像生成装置100は、1つの立体物OBに関する2つの画像OB1及び画像OB2の双方を出力画像上に表示させ、立体物OBが出力画像から消失するのを防止する。
図14は、図12の出力画像と、図12の出力画像に画像消失防止処理を適用することで得られる出力画像との違いを表す対比図であり、図14(A)が図12の出力画像を示し、図14(B)が画像消失防止処理を適用した後の出力画像を示す。図14(A)における一点鎖線で囲まれる領域R12では人物が消失しているのに対し、図14(B)における一点鎖線で囲まれる領域R14では人物が消失せずに表示されている。
次に、図15を参照しながら、画像生成装置100が、強調表示すべき所定領域を選択する処理(以下、「所定領域選択処理」とする。)について説明する。
図15は、図11における6台の物体検出センサのそれぞれの検出範囲を抜き出した図であり、6台の物体検出センサのそれぞれの検出範囲と強調表示すべき所定領域との関係を示す。なお、図15では、物体を検出した物体検出センサの検出範囲を黒色の点線で示し、物体を検出していない物体検出センサの検出範囲を灰色の点線で示す。
図15(A)は、第1左側方物体検出センサ6L1のみで物体が検出された場合に強調表示すべき所定領域として選択される領域HP1を示す。なお、斜線ハッチングで示す領域HP1は、領域ZL1から、領域ZL1及び領域ZL2の重複検出領域(AND領域)を差し引いた領域である。
また、図15(B)は、第1左側方物体検出センサ6L1及び第2左側方物体検出センサ6L2で物体が検出された場合に強調表示すべき所定領域として選択される領域HP2を示す。なお、縦縞ハッチングで示す領域HP2は、領域ZL1及び領域ZL2の合成領域(OR領域)から、領域ZL2及び領域ZB1の重複検出領域(AND領域)を差し引いた領域である。
また、図15(C)は、第2左側方物体検出センサ6L2及び第1後方物体検出センサ6B1で物体が検出された場合に強調表示すべき所定領域として選択される領域HP3を示す。なお、斜線ハッチングで示す領域HP3は、領域ZL2及び領域ZB1の合成領域(OR領域)から、領域ZL1及び領域ZL2の重複検出領域(AND領域)と領域ZB1及び領域ZB2の重複検出領域(AND領域)とを差し引いた領域である。
また、図15(D)は、第1後方物体検出センサ6B1及び第2後方物体検出センサ6B2で物体が検出された場合に強調表示すべき所定領域として選択される領域HP4を示す。なお、斜線ハッチングで示す領域HP4は、領域ZB1及び領域ZB2の合成領域(OR領域)から、領域ZL2及び領域ZB1の重複検出領域(AND領域)と領域ZB2及び領域ZR1の重複検出領域(AND領域)とを差し引いた領域である。
また、図15(E)は、第2後方物体検出センサ6B2及び第1右側方物体検出センサ6R1で物体が検出された場合に強調表示すべき所定領域として選択される領域HP5を示す。なお、斜線ハッチングで示す領域HP5は、領域ZB2及び領域ZR1の合成領域(OR領域)から、領域ZB1及び領域ZB2の重複検出領域(AND領域)と領域ZR1及び領域ZR2の重複検出領域(AND領域)とを差し引いた領域である。
また、図15(F)は、第1右側方物体検出センサ6R1及び第2右側方物体検出センサ6R2で物体が検出された場合に強調表示すべき所定領域として選択される領域HP6を示す。なお、縦縞ハッチングで示す領域HP6は、領域ZR1及び領域ZR2の合成領域(OR領域)から、領域ZB2及び領域ZR1の重複検出領域(AND領域)を差し引いた領域である。
また、図15(G)は、第2右側方物体検出センサ6R2のみで物体が検出された場合に強調表示すべき所定領域として選択される領域HP7を示す。なお、斜線ハッチングで示す領域HP7は、領域ZR2から、領域ZR1及び領域ZR2の重複検出領域(AND領域)を差し引いた領域である。
また、図15(H)は、第1左側方物体検出センサ6L1、第2左側方物体検出センサ6L2、及び第1後方物体検出センサ6B1で物体が検出された場合に強調表示すべき所定領域として選択される領域HP2及びHP3を示す。
次に、図16を参照しながら、画像生成装置100が所定領域を強調表示する処理(以下、「強調表示処理」とする。)について説明する。なお、図16は、強調表示処理の流れを示すフローチャートであり、画像生成装置100は、ショベル60が作動している間、所定周期で繰り返し強調表示処理を実行する。
最初に、画像生成装置100の制御部1における強調表示手段12は、ショベル60に取り付けられた6台の物体検出センサ6のそれぞれの出力に基づいて物体を検出したか否かを判断する(ステップS11)。
何れの物体検出センサ6においても物体を検出していないと判断した場合(ステップS11のNO)、強調表示手段12は、今回の強調表示処理を終了させる。
一方、物体を検出したと判断した場合(ステップS11のYES)、強調表示手段12は、何れの物体検出センサ6が物体を検出したかを特定する(ステップS12)。
その後、強調表示手段12は、特定結果に基づいて、複数の所定領域のうちから物体の存在が推定される所定領域を選択する(ステップS13)。具体的には、強調表示手段12は、物体を検出した物体検出センサ6の組み合わせに対応付けてROM等に予め記憶された所定領域の識別番号を読み出すことによって、1又は複数の所定領域を選択する。
その後、強調表示手段12は、選択した1又は複数の所定領域を強調表示する(ステップS14)。具体的には、強調表示手段12は、選択した1又は複数の所定領域の輪郭を出力画像上に重畳表示する。
次に、図17を参照しながら、強調表示された所定領域を含む出力画像の例について説明する。なお、図17は、図14(B)の出力画像の上に、選択された3つの所定領域の輪郭HL1〜HL3とそれら3つの輪郭HL1〜HL3のそれぞれに対応する警告マークEM1〜EM3を重畳表示した場合を示す。
図17に示すように、輪郭HL1及び警告マークEM1は、ショベル60の左側方に存在する、左側方カメラ2Lが撮像した作業員の存在を、ショベル60の操作者に分かり易く伝えることができる。
また、輪郭HL2及び警告マークEM2は、ショベル60の後方に存在する、後方カメラ2Bが撮像した作業員の存在を、ショベル60の操作者に分かり易く伝えることができる。
また、輪郭HL3及び警告マークEM3は、ショベル60の右斜め後方に存在する、後方カメラ2B及び右側方カメラ2Rの双方が撮像した作業員の存在を、ショベル60の操作者に分かり易く伝えることができる。
このように、画像生成装置100は、1つのカメラの撮像領域の一部に対応する所定領域の輪郭を重畳表示して、その撮像領域の一部における作業員の存在を、ショベル60の操作者に分かり易く伝えることができる。また、画像生成装置100は、2つのカメラの重複撮像領域に対応する所定領域の輪郭を重畳表示して、その重複撮像領域における作業員の存在を、ショベル60の操作者に分かり易く伝えることができる。
以上の構成により、画像生成装置100は、何れの物体検出センサ6が物体を検出したかを特定することによって、物体の存在が推定される領域を絞り込んだ上でその領域を強調表示する。その結果、画像生成装置100は、周囲の物体の状況をより分かり易く操作者に伝えることができる。
また、画像生成装置100は、物体検出センサ6として無指向性センサを用いた場合であっても、物体の存在が推定される領域を絞り込んだうえでその領域を強調表示する。そのため、画像生成装置100は、走査型超音波センサ若しくは走査型光センサ等の指向性センサ又は距離画像センサ等を用いなくとも、物体の存在が推定される領域を絞り込んだ上でその領域を強調表示することができる。但し、画像生成装置100は、物体検出センサ6として指向性センサ又は距離画像センサ等を用いてもよい。
以上、本発明の好ましい実施例について詳説したが、本発明は、上述した実施例に制限されることはなく、本発明の範囲を逸脱することなしに上述した実施例に種々の変形及び置換を加えることができる。
例えば、上述の実施例において、画像生成装置100は、空間モデルとして円筒状の空間モデルMDを採用するが、多角柱等の他の柱状の形状を有する空間モデルを採用してもよく、底面及び側面の二面から構成される空間モデルを採用してもよく、或いは、側面のみを有する空間モデルを採用してもよい。
また、画像生成装置100は、バケット、アーム、ブーム、旋回機構等の可動部材を備えながら自走するショベルに、カメラと共に搭載され、周囲画像をその操作者に提示しながらそのショベルの移動及びそれら可動部材の操作を支援する操作支援システムを構成する。しかしながら、画像生成装置100は、フォークリフト、アスファルトフィニッシャ等のように旋回機構を有しない作業機械、又は、産業用機械若しくは固定式クレーン等のように可動部材を有するが自走はしない作業機械に、カメラと共に搭載され、それら作業機械の操作を支援する操作支援システムを構成してもよい。
1・・・制御部 2・・・カメラ 2L・・・左側方カメラ 2R・・右側方カメラ 2B・・後方カメラ 3・・・入力部 4・・・記憶部 5・・・表示部 6・・・物体検出センサ 10・・・座標対応付け手段 11・・・画像生成手段 12・・・強調表示手段 40・・・入力画像・空間モデル対応マップ 41・・・空間モデル・処理対象画像対応マップ 42・・・処理対象画像・出力画像対応マップ 60・・・ショベル 61・・・下部走行体 62・・・旋回機構 63・・・上部旋回体 64・・・キャブ 100・・・画像生成装置

Claims (8)

  1. 作業機械に取り付けられるカメラが撮像した入力画像に基づいて出力画像を生成する作業機械用周辺監視装置であって、
    前記作業機械に取り付けられ、前記作業機械の周囲に存在する物体を検出する物体検出センサと、
    前記物体検出センサにより物体が検出された場合に、該物体を検出した物体検出センサを特定し、該特定結果に応じて前記出力画像の所定領域を強調表示する強調表示手段と、を備える、
    作業機械用周辺監視装置。
  2. 前記出力画像は、前記作業機械の周辺を俯瞰する視点変換画像であり、
    前記所定領域は、前記作業機械の位置を中心として放射状に広がる扇形領域である、
    請求項1に記載の作業機械用周辺監視装置。
  3. 前記強調表示手段は、前記物体検出センサの検出領域に基づいて設定される領域を所定領域として強調表示する、
    請求項1又は2に記載の作業機械用周辺監視装置。
  4. 前記物体検出センサは、複数の物体検出センサで構成され、
    前記複数の物体検出センサのうちの1の物体検出センサの検出領域と、前記複数の物体検出センサのうちの他の1の物体検出センサの検出領域とは重複検出領域を有し、
    前記強調表示手段は、前記1の物体検出センサが物体を検出し、前記他の1の物体検出センサが物体を検出しない場合、前記1の物体検出センサの検出領域から、前記重複検出領域を差し引いた領域を前記所定領域として強調表示する、
    請求項1乃至3の何れか一項に記載の作業機械用周辺監視装置。
  5. 前記カメラは、複数のカメラで構成され、
    前記複数のカメラのうちの1のカメラの撮像領域と、前記複数のカメラのうちの他の1のカメラの撮像領域とは重複撮像領域を有し、
    前記重複撮像領域は、前記重複検出領域と対応する、
    請求項4に記載の作業機械用周辺監視装置。
  6. 前記強調表示手段は、前記所定領域の輪郭を表示する、
    請求項1乃至5の何れか一項に記載の作業機械用周辺監視装置。
  7. 前記物体検出センサは、超音波センサ、又は、焦電型赤外線センサである、
    請求項1乃至6の何れか一項に記載の作業機械用周辺監視装置。
  8. 前記出力画像は、複数のカメラの入力画像を用いて生成される、
    請求項1乃至7の何れか一項に記載の作業機械用周辺監視装置。
JP2012207554A 2012-09-20 2012-09-20 作業機械用周辺監視装置 Active JP5960007B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2012207554A JP5960007B2 (ja) 2012-09-20 2012-09-20 作業機械用周辺監視装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012207554A JP5960007B2 (ja) 2012-09-20 2012-09-20 作業機械用周辺監視装置

Publications (2)

Publication Number Publication Date
JP2014062387A true JP2014062387A (ja) 2014-04-10
JP5960007B2 JP5960007B2 (ja) 2016-08-02

Family

ID=50617851

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012207554A Active JP5960007B2 (ja) 2012-09-20 2012-09-20 作業機械用周辺監視装置

Country Status (1)

Country Link
JP (1) JP5960007B2 (ja)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016013888A (ja) * 2014-07-01 2016-01-28 株式会社タダノ クレーン車の障害物報知システム
JP2017203352A (ja) * 2016-05-13 2017-11-16 住友重機械工業株式会社 ショベル
EP3450637A1 (en) * 2017-08-24 2019-03-06 Trimble Inc. Excavator bucket positioning via mobile device
CN110114244A (zh) * 2017-02-17 2019-08-09 住友重机械工业株式会社 工作机械用周边监视系统
US10943360B1 (en) 2019-10-24 2021-03-09 Trimble Inc. Photogrammetric machine measure up
US10996055B2 (en) 2012-11-26 2021-05-04 Trimble Inc. Integrated aerial photogrammetry surveys
KR20230122795A (ko) * 2022-02-15 2023-08-22 건설기계부품연구원 라이다와 카메라를 이용한 건설기계 안전관리 시스템

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002201676A (ja) * 2000-10-24 2002-07-19 Komatsu Ltd 作業車両の警報装置
JP2010112100A (ja) * 2008-11-07 2010-05-20 Hitachi Constr Mach Co Ltd 作業機械の監視装置
JP2011071919A (ja) * 2009-09-28 2011-04-07 Sumitomo Heavy Ind Ltd 周囲画像提示装置及び操作支援システム
JP2011221865A (ja) * 2010-04-12 2011-11-04 Sumitomo Heavy Ind Ltd 画像生成装置及び操作支援システム

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002201676A (ja) * 2000-10-24 2002-07-19 Komatsu Ltd 作業車両の警報装置
JP2010112100A (ja) * 2008-11-07 2010-05-20 Hitachi Constr Mach Co Ltd 作業機械の監視装置
JP2011071919A (ja) * 2009-09-28 2011-04-07 Sumitomo Heavy Ind Ltd 周囲画像提示装置及び操作支援システム
JP2011221865A (ja) * 2010-04-12 2011-11-04 Sumitomo Heavy Ind Ltd 画像生成装置及び操作支援システム

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10996055B2 (en) 2012-11-26 2021-05-04 Trimble Inc. Integrated aerial photogrammetry surveys
JP2016013888A (ja) * 2014-07-01 2016-01-28 株式会社タダノ クレーン車の障害物報知システム
JP2017203352A (ja) * 2016-05-13 2017-11-16 住友重機械工業株式会社 ショベル
CN110114244A (zh) * 2017-02-17 2019-08-09 住友重机械工业株式会社 工作机械用周边监视系统
EP3450637A1 (en) * 2017-08-24 2019-03-06 Trimble Inc. Excavator bucket positioning via mobile device
US10586349B2 (en) 2017-08-24 2020-03-10 Trimble Inc. Excavator bucket positioning via mobile device
US10943360B1 (en) 2019-10-24 2021-03-09 Trimble Inc. Photogrammetric machine measure up
KR20230122795A (ko) * 2022-02-15 2023-08-22 건설기계부품연구원 라이다와 카메라를 이용한 건설기계 안전관리 시스템
KR102643266B1 (ko) 2022-02-15 2024-03-04 건설기계부품연구원 라이다와 카메라를 이용한 건설기계 안전관리 시스템

Also Published As

Publication number Publication date
JP5960007B2 (ja) 2016-08-02

Similar Documents

Publication Publication Date Title
JP6029306B2 (ja) 作業機械用周辺監視装置
JP6545430B2 (ja) ショベル
JP5550970B2 (ja) 画像生成装置及び操作支援システム
JP5497617B2 (ja) 画像生成装置及び操作支援システム
JP5960007B2 (ja) 作業機械用周辺監視装置
JP6386213B2 (ja) ショベル
JP6324665B2 (ja) 作業機械用周辺監視装置
JP6045865B2 (ja) ショベル
JP6740259B2 (ja) 作業機械
JP2018017115A (ja) ショベル
JP6378801B2 (ja) ショベル
JP5752631B2 (ja) 画像生成方法、画像生成装置、及び操作支援システム
JP6169381B2 (ja) ショベル
JP5805574B2 (ja) 作業機械用周辺監視装置
JP6091821B2 (ja) ショベル
JP6257918B2 (ja) ショベル
JP6873889B2 (ja) ショベル及びショベルの周囲画像生成装置
JP6257919B2 (ja) ショベル
JP2019004484A (ja) ショベル
JP2018186575A (ja) ショベル
JP6302622B2 (ja) 作業機械用周辺監視装置
JP2020127217A (ja) ショベル
JP6295026B2 (ja) ショベル
JP7454461B2 (ja) ショベル
JP2019071677A (ja) ショベル

Legal Events

Date Code Title Description
A625 Written request for application examination (by other person)

Free format text: JAPANESE INTERMEDIATE CODE: A625

Effective date: 20150115

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20151120

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20151201

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20160201

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160622

R150 Certificate of patent or registration of utility model

Ref document number: 5960007

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150