JP2012247226A - 距離画像カメラおよび距離画像合成方法 - Google Patents
距離画像カメラおよび距離画像合成方法 Download PDFInfo
- Publication number
- JP2012247226A JP2012247226A JP2011117284A JP2011117284A JP2012247226A JP 2012247226 A JP2012247226 A JP 2012247226A JP 2011117284 A JP2011117284 A JP 2011117284A JP 2011117284 A JP2011117284 A JP 2011117284A JP 2012247226 A JP2012247226 A JP 2012247226A
- Authority
- JP
- Japan
- Prior art keywords
- distance
- information
- image
- pixel
- section
- 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.)
- Withdrawn
Links
Images
Landscapes
- Image Processing (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Measurement Of Optical Distance (AREA)
- Focusing (AREA)
- Automatic Focus Adjustment (AREA)
Abstract
【課題】単一の撮像部の画角よりも広い画角を有するとともに距離精度の高い距離画像を得ることが可能な距離画像カメラおよび距離画像合成方法を提供する。
【解決手段】同一方向に向けて配置される複数のカメラユニット10A〜10Dと、これらの制御および取得される複数の距離画像に対する演算処理を行う演算制御ユニット15とを備える。各カメラユニット10は、対象物へ向けて光を照射する発光部11と、照射された光の反射光が戻ってくるまでの時間の測定値から算出される距離情報と前記反射光の強度を示す輝度情報とを画素毎に有する距離画像を取得する撮像部12とを有する。演算制御ユニット15は、第1距離区間探索部、最近接距離区間選択部、第2距離区間探索部、距離情報置換部、2次元位置補正部および距離画像合成部とを有しており、複数の距離画像を合成した際の距離データのばらつきなどを補正する。
【選択図】図3
【解決手段】同一方向に向けて配置される複数のカメラユニット10A〜10Dと、これらの制御および取得される複数の距離画像に対する演算処理を行う演算制御ユニット15とを備える。各カメラユニット10は、対象物へ向けて光を照射する発光部11と、照射された光の反射光が戻ってくるまでの時間の測定値から算出される距離情報と前記反射光の強度を示す輝度情報とを画素毎に有する距離画像を取得する撮像部12とを有する。演算制御ユニット15は、第1距離区間探索部、最近接距離区間選択部、第2距離区間探索部、距離情報置換部、2次元位置補正部および距離画像合成部とを有しており、複数の距離画像を合成した際の距離データのばらつきなどを補正する。
【選択図】図3
Description
本発明は、距離画像カメラおよび距離画像合成方法に関し、特に、広い画角の距離画像を得ることが可能な距離画像カメラおよび距離画像合成方法に関する。
従来、画素毎に距離情報を有する距離画像を取得することが可能な装置が提案されている(例えば、特許文献1参照)。
この特許文献1に記載のレンジファインダ装置は、被写体に投射した光の反射光を受けて、前記被写体の3次元位置情報を測定するレンジファインダ装置であって、前記光を投射する光源部と、前記光源部からの投射光の前記被写体での反射光を、受けるカメラ部と、前記被写体の距離情報に基づいて、前記光源部の光出力および前記カメラ部の露出条件のうちの少なくともいずれか一方を、制御する制御部とを備えたことを特徴とするものである。
距離画像カメラの原理は、赤外光源などから照射された光の反射光が戻ってくるまでの時間の測定値から画素毎に距離を算出するというものである。通常のカメラで低輝度時の撮影に使用するフラッシュ光などとは異なり、距離画像カメラの赤外光源などから照射する光の均一性はそれほど厳しくは要求されないものの、距離測定の精度にも多少の影響を与えることから、撮像画角を広角化することはなかなか難しい。また、現時点で実用化されている距離画像カメラの画素数は、例えば、160×120ピクセル程度というようにかなり低い解像度に過ぎず、高解像度化が急速に進んでいる一般的なCMOSイメージセンサやCCDなどの撮像素子と比較すると画素数が極めて少ない。
そのため、例えば、同一のパレット上などに隣接するように載置された複数の箱などをまとめて上方から撮像したい場合など、光源部からの光が十分に届く比較的短い距離からでは、距離画像カメラの画角が狭くてすべての箱が画角内に収まらないことがある。
かといって、遠い距離から撮像しようとすると、光源部からの光が十分に届かないだけでなく、距離画像カメラの解像度が低いことから、それぞれの箱の細部の形状を認識できなかったり複数の箱を分離して認識できないことにもなり得る。
そこで、例えば、複数台の距離画像カメラを同一方向に向けて配置するとともに、隣接する別々の範囲を撮像するとともにそれぞれの距離画像を1つに合成することが考えられる。ところが、各距離画像カメラにおける距離データ(Z値)の違いなどによって合成された距離画像における箱上面部などの距離データにバラツキが生じてしまうことがある。
従来技術のこのような課題に鑑み、本発明の目的は、単一の撮像部の画角よりも広い画角を有するとともに距離精度の高い距離画像を得ることが可能な距離画像カメラおよび距離画像合成方法を提供することである。
上記目的を達成するため、本発明の距離画像カメラは、同一方向に向けて配置される複数のカメラユニットと、これらのカメラユニットの制御および取得される複数の距離画像に対する演算処理を行う演算制御ユニットとを備え、前記カメラユニットはそれぞれ、対象物へ向けて光を照射する発光部と、この発光部から照射された光の反射光が戻ってくるまでの時間の測定値から算出される距離情報を2次元配置された画素毎に有するとともに、前記画素毎に前記反射光の強度を示す輝度情報も有する距離画像を取得する撮像部とを有し、前記演算制御ユニットは、前記複数のカメラユニットで取得した各距離画像について、前記撮像位置からの距離を複数の距離区間に分割するとともに、前記撮像位置に近い前記距離区間から順にその距離画像の各画素の前記距離情報が含まれる画素数を集計し、その集計画素数が第1所定数以上で且つ最初に極大となった前記距離区間を1つ選択する第1距離区間探索部と、この第1距離区間探索部で前記各距離画像についてそれぞれ選択された前記距離区間のうちからそれぞれの前記撮像位置に最も近接している前記距離区間を1つ選択する最近接距離区間選択部と、この最近接距離区間選択部で選択された前記距離区間の近距離側境界までの距離とそれに所定距離を加えた距離との間の距離範囲を複数の小距離区間に分割し、前記各距離画像について、前記撮像位置に近い前記小距離区間から順にその距離画像の各画素の前記距離情報が含まれる画素数を集計し、その集計画素数が第2所定数以上で且つ最初に極大となった前記小距離区間を1つ選択する第2距離区間探索部と、この第2距離区間探索部で前記各距離画像についてそれぞれ選択された前記小距離区間のうちから前記集計画素数が最大である前記小距離区間に前記距離情報が含まれる各画素の前記距離情報の平均である平均距離情報を求め、前記各距離画像についてそれぞれ選択された前記小距離区間に前記距離情報が含まれる各画素の前記距離情報を前記平均距離情報で置換する距離情報置換部と、この距離情報置換部で求められた前記平均距離情報と前記各距離画像の各画素の2次元画素位置とに基づいて各画素の2次元位置情報を補正する2次元位置補正部と、この2次元位置補正部で補正された各画素の前記2次元位置情報と前記距離情報とを共通の3次元座標系に変換することによって前記各距離画像を合成した合成距離画像を求める距離画像合成部とを有することを特徴とする。
このような構成の距離画像カメラによれば、単一の撮像部の画角よりも広い画角を有するとともに距離精度の高い距離画像を得ることが可能となる。
また、本発明の距離画像カメラにおいて、前記第1距離区間探索部および前記第2距離区間探索部における画素数の集計では、輝度情報が所定範囲外である画素を除外するようにしてもよい。
このような構成の距離画像カメラによれば、信頼性に乏しいと考えられる距離データは使用しないので、合成距離画像の距離精度をより高めることができる。
また、本発明の距離画像カメラにおいて、前記第2距離区間探索部では、前記集計画素数が前記第2所定数以上で且つ最初に極大となった前記小距離区間が見つからなかった場合は、当該距離画像の各画素の前記2次元位置情報および前記距離情報を初期化するようにしてもよい。
このような構成の距離画像カメラによれば、前記第2距離区間探索部における誤った前記小距離区間の選択を防止して、それ以降の前記距離情報置換部、前記2次元位置補正部および前記距離画像合成部などで誤った演算処理などが行われることを回避できる。
また、本発明の距離画像カメラにおいて、前記距離画像合成部では、予め記録された撮像対象物の形状情報に基づいて前記合成距離画像の補正を行うようにしてもよい。
このような構成の距離画像カメラによれば、前記合成距離画像中の撮像対象物の形状の誤差や歪みなどを補正してより的確な認識を行うことができる。
あるいは、上記目的を達成するため、本発明の距離画像合成方法は、照射した光の反射光が戻ってくるまでの時間の測定値から算出される距離情報を2次元配置された画素毎に有するとともに、前記画素毎に前記反射光の強度を示す輝度情報も有する距離画像の取得を複数の撮像位置から同一方向を向いてそれぞれ行う距離画像取得工程と、この距離画像取得工程で取得した各距離画像について、前記撮像位置からの距離を複数の距離区間に分割するとともに、前記撮像位置に近い前記距離区間から順にその距離画像の各画素の前記距離情報が含まれる画素数を集計し、その集計画素数が第1所定数以上で且つ最初に極大となった前記距離区間を1つ選択する第1距離区間探索工程と、この第1距離区間探索工程で前記各距離画像についてそれぞれ選択された前記距離区間のうちからそれぞれの前記撮像位置に最も近接している前記距離区間を1つ選択する最近接距離区間選択工程と、この最近接距離区間選択工程で選択された前記距離区間の近距離側境界までの距離とそれに所定距離を加えた距離との間の距離範囲を複数の小距離区間に分割し、前記各距離画像について、前記撮像位置に近い前記小距離区間から順にその距離画像の各画素の前記距離情報が含まれる画素数を集計し、その集計画素数が第2所定数以上で且つ最初に極大となった前記小距離区間を1つ選択する第2距離区間探索工程と、この第2距離区間探索工程で前記各距離画像についてそれぞれ選択された前記小距離区間のうちから前記集計画素数が最大である前記小距離区間に前記距離情報が含まれる各画素の前記距離情報の平均である平均距離情報を求め、前記各距離画像についてそれぞれ選択された前記小距離区間に前記距離情報が含まれる各画素の前記距離情報を前記平均距離情報で置換する距離情報置換工程と、この距離情報置換工程で求められた前記平均距離情報と前記各距離画像の各画素の2次元画素位置とに基づいて各画素の2次元位置情報を補正する2次元位置補正工程と、この2次元位置補正工程で補正された各画素の前記2次元位置情報と前記距離情報とを共通の3次元座標系に変換することによって前記各距離画像を合成した合成距離画像を求める距離画像合成工程とを含むことを特徴とする。
このような構成の距離画像合成方法によれば、単一の撮像部の画角よりも広い画角を有するとともに距離精度の高い距離画像を得ることが可能となる。
また、本発明の距離画像合成方法において、前記第1距離区間探索工程および前記第2距離区間探索工程における画素数の集計では、輝度情報が所定範囲外である画素を除外するようにしてもよい。
このような構成の距離画像合成方法によれば、信頼性に乏しいと考えられる距離データは使用しないので、合成距離画像の距離精度をより高めることができる。
また、本発明の距離画像合成方法において、前記第2距離区間探索工程では、前記集計画素数が前記第2所定数以上で且つ最初に極大となった前記小距離区間が見つからなかった場合は、当該距離画像の各画素の前記2次元位置情報および前記距離情報を初期化するようにしてもよい。
このような構成の距離画像合成方法によれば、前記第2距離区間探索工程における誤った前記小距離区間の選択を防止して、それ以降の前記距離情報置換工程、前記2次元位置補正工程および前記距離画像合成工程などで誤った演算処理などが行われることを回避できる。
また、本発明の距離画像合成方法において、前記距離画像合成工程では、予め記録された撮像対象物の形状情報に基づいて前記合成距離画像の補正を行うようにしてもよい。
このような構成の距離画像合成方法によれば、前記合成距離画像中の撮像対象物の形状の誤差や歪みなどを補正してより的確な認識を行うことができる。
本発明の距離画像カメラおよび距離画像合成方法によれば、単一の撮像部の画角よりも広い画角を有するとともに距離精度の高い距離画像を得ることが可能となる。
以下、本発明の実施形態を、図面を参照して説明する。
<距離画像カメラ100の概略構成など>
図1は、本発明の一実施形態に係る距離画像カメラ100の概略構成を示すブロック図である。図2は、距離画像カメラ100が備える4台のカメラユニット10A〜10Dに共通の概略構成を示すブロック図である。
図1は、本発明の一実施形態に係る距離画像カメラ100の概略構成を示すブロック図である。図2は、距離画像カメラ100が備える4台のカメラユニット10A〜10Dに共通の概略構成を示すブロック図である。
図1に示すように、距離画像カメラ100は、同一方向に向けて配置される4台のカメラユニット10A〜10D(以下で区別が不要な場合には単に「カメラユニット10」と記す)と、これらの制御および演算処理(詳細は後述)などを行う演算制御ユニット15とを備えている。ただし、カメラユニット10の台数は4に限るわけではなく、2台以上であればよい。
また、図2に示すように、各カメラユニット10はいずれも、撮像対象物へ向けて赤外光を照射する赤外発光部11と、この赤外発光部11から照射された赤外光が反射されて戻ってくるまでの時間の測定値に基づいて算出される距離データ(Z値)を2次元格子状に配置された画素毎に有する距離画像を取得することが可能なイメージセンサ12と、赤外発光部11による赤外光の照射(照射強度、照射時間やタイミングなど)やイメージセンサ12による距離画像の取得などの制御を行う制御部13と、この制御部13と外部とのインターフェイス14とを備えている。なお、イメージセンサ12によって取得された距離画像の各画素は、反射光の強度を示す輝度データ(Active Brightness、A値)もそれぞれ有している。
赤外発光部11としては、例えば、赤外光を発する発光ダイオードや半導体レーザなどが挙げられるが、これらに限られない。
イメージセンサ12としては、例えば、いわゆるTOF(Time of Flight)センサなどが挙げられるが、これに限られない。
制御部13および演算制御ユニット15としては、例えば、CPUが挙げられるが、これに限られない。ここで、制御部13は、赤外発光部11による赤外光の照射を高速で制御したり、照射された赤外光が反射されて戻ってくるまでの時間を精密に測定したりする必要があり、一方、演算制御ユニット15は後述するような複雑な演算処理を行う必要がある。このようなことを考慮して、適切な種類のCPUなどを選択すればよい。
インターフェイス14としては、例えば、USB、IEEE1394などが挙げられるが、これらに限られない。
なお、各カメラユニット10の制御部13やインターフェイス14は必ずしも不可欠なものではない。例えば、演算制御ユニット15側に各カメラユニット10とのインターフェイスを備えるとともに、演算制御ユニット15が各カメラユニット10の赤外発光部11やイメージセンサ12を直接制御するような構成としてもよい。
<距離画像カメラ100による距離画像の取得および合成>
図3は、パレット21上に隣接するように載置された高さの異なる箱20A、20Bを距離画像カメラ100のカメラユニット10A〜10Dによって上方から撮像する場合の位置関係などを示す概略図である。図4(a)〜図4(d)は、カメラユニット10A〜10Dによって取得された距離画像の例を示す概略図である。図5(a)〜図5(d)は、カメラユニット10A〜10Dによって取得された距離画像の距離データの例を示すグラフである。図6は、カメラユニット10Cからの撮像方向に沿った距離Zを複数に分割した距離区間の例などを示す概略説明図である。図7は、距離区間毎の画素数の集計例を示すグラフである。
図3は、パレット21上に隣接するように載置された高さの異なる箱20A、20Bを距離画像カメラ100のカメラユニット10A〜10Dによって上方から撮像する場合の位置関係などを示す概略図である。図4(a)〜図4(d)は、カメラユニット10A〜10Dによって取得された距離画像の例を示す概略図である。図5(a)〜図5(d)は、カメラユニット10A〜10Dによって取得された距離画像の距離データの例を示すグラフである。図6は、カメラユニット10Cからの撮像方向に沿った距離Zを複数に分割した距離区間の例などを示す概略説明図である。図7は、距離区間毎の画素数の集計例を示すグラフである。
図3に示すように、カメラユニット10A〜10Dは、箱20A、20Bの上方の正方形の各頂点に相当する位置において、各撮像方向がいずれも同一となるように真下に向けて配置される。ただし、各カメラユニット10の配置はこれに限らない。
ここで、箱20A、20Bの各上面の高さにおいて、各カメラユニット10によって取得される距離画像の周辺の少なくとも一部が、他のカメラユニット10によって取得される距離画像とオーバーラップするように、各カメラユニット10の配置間隔を定める必要がある。例えば、箱20Aの上面の高さにおいて、カメラユニット10Cによって取得される距離画像に相当する範囲R10Cの周辺部が、カメラユニット10Aによって取得される距離画像に相当する範囲R10Aやカメラユニット10Dによって取得される距離画像に相当する範囲R10Dそれぞれの周辺部と一定幅で相互にオーバーラップするように、カメラユニット10A〜10D相互の配置間隔を定めればよい。
以下では、距離画像カメラ100による距離画像の取得および合成の各ステップを詳細に説明する。
(1)カメラユニット10A〜10Dによる箱20A、20Bの撮像
まず、カメラユニット10A〜10Dによって箱20A、20Bを含む撮像空間の距離画像をそれぞれ取得する。カメラユニット10A〜10Dによって取得された距離画像の例を図4(a)〜図4(d)に示しておく。また、この時点では、図5(a)〜図5(d)に示すように、本来は箱20Aまたは箱20Bの同一正面を撮像しているにも関わらず、距離データがばらついている可能性がある。
まず、カメラユニット10A〜10Dによって箱20A、20Bを含む撮像空間の距離画像をそれぞれ取得する。カメラユニット10A〜10Dによって取得された距離画像の例を図4(a)〜図4(d)に示しておく。また、この時点では、図5(a)〜図5(d)に示すように、本来は箱20Aまたは箱20Bの同一正面を撮像しているにも関わらず、距離データがばらついている可能性がある。
なお、距離画像の各画素は2次元格子状に配置されており、各画素がXY平面上の位置データx、yおよび撮像方向(Z方向)の距離データ(Z値)を有している(図6参照)。さらに、各画素は輝度データ(A値)も有しているので、換言すると、各画素はA,X,Y、Zの4次元座標のデータを有している。
(2)各距離画像内での箱20A、20Bの上面の探索
各カメラユニット10について、その撮像方向に沿った距離を予め所定区間幅R(図6参照)の複数の距離区間に分割しておき、箱20Aまたは箱20Bの上面が含まれると推定される距離区間を探索する。なお、複数の距離区間への分割はこのような等間隔に限るわけではない。
各カメラユニット10について、その撮像方向に沿った距離を予め所定区間幅R(図6参照)の複数の距離区間に分割しておき、箱20Aまたは箱20Bの上面が含まれると推定される距離区間を探索する。なお、複数の距離区間への分割はこのような等間隔に限るわけではない。
具体的には、各カメラユニット10の距離画像について、カメラユニット10に近い方の距離区間から順に、距離画像の各画素の距離データがその距離区間に含まれている画素数を集計するとともにその直前の距離区間で集計した画素数と比較し、集計画素数が最初にピークとなった距離区間を選択して探索を終了する。例えば、カメラユニット10Cの距離画像について距離区間毎の集計画素数がピークとなるのは、図6に示した例では、近距離側境界値がZc1で遠距離側境界値がZc2である距離区間であろうと考えられる。
なお、距離区間毎の集計画素数は、例えば、図7に示すように変化するが、箱20Aまたは箱20Bの上面の探索では、集計画素数がその距離区間の距離に応じた所定値Pth以上であることを条件とし、その所定値Pth未満であればその距離区間を選択せずに、それ以降の距離区間で探索を続けるようにする。ここで、所定値Pthは距離値によって決定され、その場合の距離値は、探索距離区間の遠距離側境界値に従うものとする。これは、距離区間毎の集計画素数のピーク検出を単純な大小比較のみで行っているため、該当する集計画素数自体は極めて少ないものの隣接する距離区間との間で集計画素数に僅かな減少があっただけでそこが誤ってピークと判定されることを防止するためである。なお、図7では、簡単化のために所定値Pthを距離に依存しない一定値としているが、これに限られない。
また、距離区間毎の画素数の集計の際、輝度データが異常値であるような画素の距離データは信頼性に乏しいと考えられるため、集計対象から除外するようにしてもよい。
以上のように、集計画素数がピークとなる距離区間の探索をカメラユニット10A〜10Dの各距離画像に対して行う。
ここで、カメラユニット10A〜10Dについて、集計画素数がピークとして選択された距離区間(近距離側境界値および遠距離側境界値)、各画素が有するデータおよび集計画素数を次のような不等式および記号で表すこととしておく。
[カメラユニット10A]
距離区間 :Za1≦Za<Za2
画素データ:(Aa、Xa、Ya,Za)
画素数 :Pa
[カメラユニット10B]
距離区間 :Zb1≦Zb<Zb2
画素データ:(Ab、Xb、Yb,Zb)
画素数 :Pb
[カメラユニット10C]
距離区間 :Zc1≦Zc<Zc2
画素データ:(Ac、Xc、Yc,Zc)
画素数 :Pc
[カメラユニット10D]
距離区間 :Zd1≦Zd<Zd2
画素データ:(Ad、Xd、Yd,Zd)
画素数 :Pd
(3)各距離画像内で探索された箱20A、20Bの上面の相互比較
上記ステップ(2)で探索した各カメラユニット10の距離画像内における箱20Aまたは箱20Bの上面の高さ同士を、選択された距離区間の近距離側境界値によって相互比較し、最も上にある(各カメラユニット10に最も近接している)ものを選び出す。
距離区間 :Za1≦Za<Za2
画素データ:(Aa、Xa、Ya,Za)
画素数 :Pa
[カメラユニット10B]
距離区間 :Zb1≦Zb<Zb2
画素データ:(Ab、Xb、Yb,Zb)
画素数 :Pb
[カメラユニット10C]
距離区間 :Zc1≦Zc<Zc2
画素データ:(Ac、Xc、Yc,Zc)
画素数 :Pc
[カメラユニット10D]
距離区間 :Zd1≦Zd<Zd2
画素データ:(Ad、Xd、Yd,Zd)
画素数 :Pd
(3)各距離画像内で探索された箱20A、20Bの上面の相互比較
上記ステップ(2)で探索した各カメラユニット10の距離画像内における箱20Aまたは箱20Bの上面の高さ同士を、選択された距離区間の近距離側境界値によって相互比較し、最も上にある(各カメラユニット10に最も近接している)ものを選び出す。
具体的には、カメラユニット10A〜10Dのそれぞれの距離画像に基づいて選択された距離区間の近距離側境界値Za1、Zb1、Zc1、Zd1のうちから最小のもの(各カメラユニット10に最も近接している距離区間の近距離側境界値)を選び、それをZmとする。
例えば、カメラユニット10Aに対応する近距離側境界値Za1が他の近距離側境界値Zb1、Zc1、Zd1のいずれよりも小さければ、
最小値Zm=Za1
とする。あるいは、例えば、近距離側境界値Za1が近距離側境界値Zb1と等しく、且つ、他の近距離側境界値Zc1、Zd1のいずれよりも小さければ、
最小値Zm=Za1=Zb1
となる。
最小値Zm=Za1
とする。あるいは、例えば、近距離側境界値Za1が近距離側境界値Zb1と等しく、且つ、他の近距離側境界値Zc1、Zd1のいずれよりも小さければ、
最小値Zm=Za1=Zb1
となる。
(4)最近設距離区間近傍での箱20A、20Bの上面の再探索
上記ステップ(3)で求めた最小値Zmを基準とし、箱20Aまたは箱20Bの上面を含む距離区間の近距離境界値がこの最小値Zmより大きかったカメラユニット10については、再び箱20Aまたは箱20Bの上面探索を行う。ただし、高さが微小に異なる箱と区別するために分離定数αを設定して、近距離側境界値がZmで遠距離側境界値がZm+αである距離範囲内のみで探索する。
上記ステップ(3)で求めた最小値Zmを基準とし、箱20Aまたは箱20Bの上面を含む距離区間の近距離境界値がこの最小値Zmより大きかったカメラユニット10については、再び箱20Aまたは箱20Bの上面探索を行う。ただし、高さが微小に異なる箱と区別するために分離定数αを設定して、近距離側境界値がZmで遠距離側境界値がZm+αである距離範囲内のみで探索する。
この距離範囲を複数に分割した距離区間の幅は、上記ステップ(2)における距離区間の幅よりずっと狭くなるので、これらの距離区間を以下では「小距離区間」と呼ぶことにする。上記ステップ(2)と同様に、近距離側境界値Zmに近い方の小距離区間から順に、距離画像の各画素の距離データが含まれている画素数を集計するとともにその直前の小距離区間で集計した画素数と比較し、集計画素数が最初にピークとなった小距離区間を選択して探索を終了する。
ただし、やはり集計画素数が一定数以上であることを条件とし、その一定数未満であればその小距離区間を選択せずに、それ以降の小距離区間で探索を続ける。遠距離側境界値がZm+αである小距離区間まで探索しても箱20Aまたは箱20Bの上面が見つからなかった場合には、上記ステップ(3)で選択された最小値Zmに対応する箱20Aまたは箱20Bの上面と同一面は、この探索対象の距離画像を取得したカメラユニット10では撮像されていないと判断できるので、画素データを初期化する。すなわち、
画素データ(X,Y,Z)=0
とする。
画素データ(X,Y,Z)=0
とする。
このような再探索によって箱20A、20Bの上面が見つかった場合、その距離区間(近距離側境界値および遠距離側境界値)、各画素が有するデータおよび集計画素数を次のような不等式および記号で表すこととしておく。
[カメラユニット10A]
距離区間 :Z’a1≦Z’a<Z’a2
画素データ:(A’a、X’a、Y’a,Z’a)
画素数 :P’a
[カメラユニット10B]
距離区間 :Z’b1≦Z’b<Z’b2
画素データ:(A’b、X’b、Y’b,Z’b)
画素数 :P’b
[カメラユニット10C]
距離区間 :Z’c1≦Z’c<Z’c2
画素データ:(A’c、X’c、Y’c,Z’c)
画素数 :P’c
[カメラユニット10D]
距離区間 :Z’d1≦Z’d<Z’d2
画素データ:(A’d、X’d、Y’d,Z’d)
画素数 :P’d
なお、箱20A、20Bの上面が見つからなかった距離画像を取得したカメラユニット10については、上記ステップ(2)の通りである。
距離区間 :Z’a1≦Z’a<Z’a2
画素データ:(A’a、X’a、Y’a,Z’a)
画素数 :P’a
[カメラユニット10B]
距離区間 :Z’b1≦Z’b<Z’b2
画素データ:(A’b、X’b、Y’b,Z’b)
画素数 :P’b
[カメラユニット10C]
距離区間 :Z’c1≦Z’c<Z’c2
画素データ:(A’c、X’c、Y’c,Z’c)
画素数 :P’c
[カメラユニット10D]
距離区間 :Z’d1≦Z’d<Z’d2
画素データ:(A’d、X’d、Y’d,Z’d)
画素数 :P’d
なお、箱20A、20Bの上面が見つからなかった距離画像を取得したカメラユニット10については、上記ステップ(2)の通りである。
(5)箱20Aまたは箱20Bの上面に対応する距離データの平均化処理
上記ステップ(4)で探索された箱20Aまたは箱20Bの上面を含む小距離区間に距離データが含まれる画素数の集計、それらの画素の距離データおよび輝度データのそれぞれの平均を各カメラユニット10について求める。
上記ステップ(4)で探索された箱20Aまたは箱20Bの上面を含む小距離区間に距離データが含まれる画素数の集計、それらの画素の距離データおよび輝度データのそれぞれの平均を各カメラユニット10について求める。
ここで、カメラユニット10A〜10Dについて、箱20Aまたは箱20Bの上面を含む距離区間、距離データ平均値、および輝度データ平均値をそれぞれ次のような不等式または記号で表すこととする。
[カメラユニット10A]
距離区間:Za1≦Za<Za2 または Z’a1≦Z’a<Z’a2
距離データ平均値:Za-mean
輝度データ平均値:Aa-mean
[カメラユニット10B]
距離区間:Zb1≦Zb<Zb2 または Z’b1≦Z’b<Z’b2
距離データ平均値:Zb-mean
輝度データ平均値:Ab-mean
[カメラユニット10C]
距離区間:Zc1≦Zc<Zc2 または Z’c1≦Z’c<Z’c2
距離データ平均値:Zc-mean
輝度データ平均値:Ac-mean
[カメラユニット10D]
距離区間:Zd1≦Zd<Zd2 または Z’d1≦Z’d<Z’d2
距離データ平均値:Zd-mean
輝度データ平均値:Ad-mean
(6)各カメラユニット10の集計画素数の相互比較
上記ステップ(5)で求められた各カメラユニット10の集計画素数を相互比較し、それが最大であるカメラユニット10の距離データ平均値を選んでZmeanとする。
距離区間:Za1≦Za<Za2 または Z’a1≦Z’a<Z’a2
距離データ平均値:Za-mean
輝度データ平均値:Aa-mean
[カメラユニット10B]
距離区間:Zb1≦Zb<Zb2 または Z’b1≦Z’b<Z’b2
距離データ平均値:Zb-mean
輝度データ平均値:Ab-mean
[カメラユニット10C]
距離区間:Zc1≦Zc<Zc2 または Z’c1≦Z’c<Z’c2
距離データ平均値:Zc-mean
輝度データ平均値:Ac-mean
[カメラユニット10D]
距離区間:Zd1≦Zd<Zd2 または Z’d1≦Z’d<Z’d2
距離データ平均値:Zd-mean
輝度データ平均値:Ad-mean
(6)各カメラユニット10の集計画素数の相互比較
上記ステップ(5)で求められた各カメラユニット10の集計画素数を相互比較し、それが最大であるカメラユニット10の距離データ平均値を選んでZmeanとする。
ただし、そのカメラユニット10の輝度データ平均値が所定範囲内になければそのカメラユニット10は除外し、他のカメラユニット10の中から次に集計画素数が大きいカメラユニット10の距離データ平均値を選ぶようにする。
(7)距離データ平均値の割り当ておよび2次元位置データの補正
上記ステップ(6)で選んだ距離データ平均値Zmeanを、上記ステップ(4)で探索された箱20Aまたは箱20Bの上面を含む距離区間に距離データが含まれる画素の距離データとして割り当てる。つまり、これらの画素の距離データについては、すべて同一の距離データ平均値Zmeanに置き換える。
上記ステップ(6)で選んだ距離データ平均値Zmeanを、上記ステップ(4)で探索された箱20Aまたは箱20Bの上面を含む距離区間に距離データが含まれる画素の距離データとして割り当てる。つまり、これらの画素の距離データについては、すべて同一の距離データ平均値Zmeanに置き換える。
また、画素位置(X方向およびY方向)と距離データ平均値Zmeanに基づいて、各画素の2次元位置データ、すなわち、X値およびY値を補正する。
(8)各距離画像の座標変換および合成
各カメラユニット10の設置時のキャリブレーションによって得られたカメラパラメータ(内部および外部)にしたがって、各距離画像の各画素のX値、Y値、Z値をカメラ座標系または世界座標系にそれぞれ座標変換することで各距離画像を合成する。
各カメラユニット10の設置時のキャリブレーションによって得られたカメラパラメータ(内部および外部)にしたがって、各距離画像の各画素のX値、Y値、Z値をカメラ座標系または世界座標系にそれぞれ座標変換することで各距離画像を合成する。
各カメラユニット10から遠距離側では、複数のカメラユニット10に撮像されている重複部分が存在している。この場合、各距離画像の合成時には、上記ステップ(7)で得られた距離データ平均値Zmeanから一定距離の間にある画素の平均を取る。あるいは、一方のデータを除去するようにしてもよい。
必要な場合には、合成された距離画像のデータ上でテンプレートマッチングなどの手法を用いて箱20Aや箱20Bの形状を補正するようにしてもよい。
なお、本発明は、その主旨または主要な特徴から逸脱することなく、他のいろいろな形で実施することができる。そのため、上述の実施形態はあらゆる点で単なる例示にすぎず、限定的に解釈してはならない。本発明の範囲は特許請求の範囲によって示すものであって、明細書本文にはなんら拘束されない。さらに、特許請求の範囲の均等範囲に属する変形や変更は、全て本発明の範囲内のものである。
100 距離画像カメラ
10(10A〜10D)
カメラユニット
11 赤外発光部
12 イメージセンサ
13 制御部
14 インターフェイス
15 演算制御ユニット
20A 箱
20B 箱
21 パレット
10(10A〜10D)
カメラユニット
11 赤外発光部
12 イメージセンサ
13 制御部
14 インターフェイス
15 演算制御ユニット
20A 箱
20B 箱
21 パレット
Claims (8)
- 同一方向に向けて配置される複数のカメラユニットと、
これらのカメラユニットの制御および取得される複数の距離画像に対する演算処理を行う演算制御ユニットとを備え、
前記カメラユニットはそれぞれ、
対象物へ向けて光を照射する発光部と、
この発光部から照射された光の反射光が戻ってくるまでの時間の測定値から算出される距離情報を2次元配置された画素毎に有するとともに、前記画素毎に前記反射光の強度を示す輝度情報も有する距離画像を取得する撮像部とを有し、
前記演算制御ユニットは、
前記複数のカメラユニットで取得した各距離画像について、前記撮像位置からの距離を複数の距離区間に分割するとともに、前記撮像位置に近い前記距離区間から順にその距離画像の各画素の前記距離情報が含まれる画素数を集計し、その集計画素数が第1所定数以上で且つ最初に極大となった前記距離区間を1つ選択する第1距離区間探索部と、
この第1距離区間探索部で前記各距離画像についてそれぞれ選択された前記距離区間のうちからそれぞれの前記撮像位置に最も近接している前記距離区間を1つ選択する最近接距離区間選択部と、
この最近接距離区間選択部で選択された前記距離区間の近距離側境界までの距離とそれに所定距離を加えた距離との間の距離範囲を複数の小距離区間に分割し、前記各距離画像について、前記撮像位置に近い前記小距離区間から順にその距離画像の各画素の前記距離情報が含まれる画素数を集計し、その集計画素数が第2所定数以上で且つ最初に極大となった前記小距離区間を1つ選択する第2距離区間探索部と、
この第2距離区間探索部で前記各距離画像についてそれぞれ選択された前記小距離区間のうちから前記集計画素数が最大である前記小距離区間に前記距離情報が含まれる各画素の前記距離情報の平均である平均距離情報を求め、前記各距離画像についてそれぞれ選択された前記小距離区間に前記距離情報が含まれる各画素の前記距離情報を前記平均距離情報で置換する距離情報置換部と、
この距離情報置換部で求められた前記平均距離情報と前記各距離画像の各画素の2次元画素位置とに基づいて各画素の2次元位置情報を補正する2次元位置補正部と、
この2次元位置補正部で補正された各画素の前記2次元位置情報と前記距離情報とを共通の3次元座標系に変換することによって前記各距離画像を合成した合成距離画像を求める距離画像合成部とを
有することを特徴とする距離画像カメラ。 - 請求項1に記載の距離画像カメラにおいて、
前記第1距離区間探索部および前記第2距離区間探索部における画素数の集計では、輝度情報が所定範囲外である画素を除外することを特徴とする距離画像カメラ。 - 請求項1または2に記載の距離画像カメラにおいて、
前記第2距離区間探索部では、前記集計画素数が前記第2所定数以上で且つ最初に極大となった前記小距離区間が見つからなかった場合は、当該距離画像の各画素の前記2次元位置情報および前記距離情報を初期化することを特徴とする距離画像カメラ。 - 請求項1〜3のいずれか1項に記載の距離画像カメラにおいて、
前記距離画像合成部では、予め記録された撮像対象物の形状情報に基づいて前記合成距離画像の補正を行うことを特徴とする距離画像カメラ。 - 照射した光の反射光が戻ってくるまでの時間の測定値から算出される距離情報を2次元配置された画素毎に有するとともに、前記画素毎に前記反射光の強度を示す輝度情報も有する距離画像の取得を複数の撮像位置から同一方向を向いてそれぞれ行う距離画像取得工程と、
この距離画像取得工程で取得した各距離画像について、前記撮像位置からの距離を複数の距離区間に分割するとともに、前記撮像位置に近い前記距離区間から順にその距離画像の各画素の前記距離情報が含まれる画素数を集計し、その集計画素数が第1所定数以上で且つ最初に極大となった前記距離区間を1つ選択する第1距離区間探索工程と、
この第1距離区間探索工程で前記各距離画像についてそれぞれ選択された前記距離区間のうちからそれぞれの前記撮像位置に最も近接している前記距離区間を1つ選択する最近接距離区間選択工程と、
この最近接距離区間選択工程で選択された前記距離区間の近距離側境界までの距離とそれに所定距離を加えた距離との間の距離範囲を複数の小距離区間に分割し、前記各距離画像について、前記撮像位置に近い前記小距離区間から順にその距離画像の各画素の前記距離情報が含まれる画素数を集計し、その集計画素数が第2所定数以上で且つ最初に極大となった前記小距離区間を1つ選択する第2距離区間探索工程と、
この第2距離区間探索工程で前記各距離画像についてそれぞれ選択された前記小距離区間のうちから前記集計画素数が最大である前記小距離区間に前記距離情報が含まれる各画素の前記距離情報の平均である平均距離情報を求め、前記各距離画像についてそれぞれ選択された前記小距離区間に前記距離情報が含まれる各画素の前記距離情報を前記平均距離情報で置換する距離情報置換工程と、
この距離情報置換工程で求められた前記平均距離情報と前記各距離画像の各画素の2次元画素位置とに基づいて各画素の2次元位置情報を補正する2次元位置補正工程と、
この2次元位置補正工程で補正された各画素の前記2次元位置情報と前記距離情報とを共通の3次元座標系に変換することによって前記各距離画像を合成した合成距離画像を求める距離画像合成工程と
を含むことを特徴とする距離画像合成方法。 - 請求項5に記載の距離画像合成方法において、
前記第1距離区間探索工程および前記第2距離区間探索工程における画素数の集計では、輝度情報が所定範囲外である画素を除外することを特徴とする距離画像合成方法。 - 請求項5または6に記載の距離画像合成方法において、
前記第2距離区間探索工程では、前記集計画素数が前記第2所定数以上で且つ最初に極大となった前記小距離区間が見つからなかった場合は、当該距離画像の各画素の前記2次元位置情報および前記距離情報を初期化することを特徴とする距離画像合成方法。 - 請求項5〜7のいずれか1項に記載の距離画像合成方法において、
前記距離画像合成工程では、予め記録された撮像対象物の形状情報に基づいて前記合成距離画像の補正を行うことを特徴とする距離画像合成方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011117284A JP2012247226A (ja) | 2011-05-25 | 2011-05-25 | 距離画像カメラおよび距離画像合成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011117284A JP2012247226A (ja) | 2011-05-25 | 2011-05-25 | 距離画像カメラおよび距離画像合成方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2012247226A true JP2012247226A (ja) | 2012-12-13 |
Family
ID=47467814
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011117284A Withdrawn JP2012247226A (ja) | 2011-05-25 | 2011-05-25 | 距離画像カメラおよび距離画像合成方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2012247226A (ja) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016008875A (ja) * | 2014-06-24 | 2016-01-18 | 株式会社リコー | 距離測定装置 |
JP2018040755A (ja) * | 2016-09-09 | 2018-03-15 | 日産自動車株式会社 | 座標計算方法及び座標計算装置 |
JP2018077196A (ja) * | 2016-11-11 | 2018-05-17 | スタンレー電気株式会社 | 監視システム |
CN109756665A (zh) * | 2017-11-02 | 2019-05-14 | 株式会社日立制作所 | 距离图像摄像机、距离图像摄像机系统及其控制方法 |
US10775502B2 (en) | 2016-11-10 | 2020-09-15 | Ricoh Company, Ltd | Distance-measuring apparatus, mobile object, robot, three-dimensional measuring device, surveillance camera, and distance-measuring method |
EP2978207B1 (en) * | 2014-07-25 | 2022-11-23 | Lockheed Martin Corporation | Enhanced optical detection and ranging |
-
2011
- 2011-05-25 JP JP2011117284A patent/JP2012247226A/ja not_active Withdrawn
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016008875A (ja) * | 2014-06-24 | 2016-01-18 | 株式会社リコー | 距離測定装置 |
EP2978207B1 (en) * | 2014-07-25 | 2022-11-23 | Lockheed Martin Corporation | Enhanced optical detection and ranging |
JP2018040755A (ja) * | 2016-09-09 | 2018-03-15 | 日産自動車株式会社 | 座標計算方法及び座標計算装置 |
US10775502B2 (en) | 2016-11-10 | 2020-09-15 | Ricoh Company, Ltd | Distance-measuring apparatus, mobile object, robot, three-dimensional measuring device, surveillance camera, and distance-measuring method |
JP2018077196A (ja) * | 2016-11-11 | 2018-05-17 | スタンレー電気株式会社 | 監視システム |
CN109756665A (zh) * | 2017-11-02 | 2019-05-14 | 株式会社日立制作所 | 距离图像摄像机、距离图像摄像机系统及其控制方法 |
US10462356B2 (en) | 2017-11-02 | 2019-10-29 | Hitachi, Ltd. | Range image camera, range image camera system, and control method of them |
CN109756665B (zh) * | 2017-11-02 | 2020-09-22 | 株式会社日立制作所 | 距离图像摄像机、距离图像摄像机系统及其控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2012247226A (ja) | 距離画像カメラおよび距離画像合成方法 | |
US9807369B2 (en) | 3D imaging apparatus | |
US9383549B2 (en) | Imaging system | |
CN106875435B (zh) | 获取深度图像的方法及系统 | |
US20150292884A1 (en) | Motion-sensor device having multiple light sources | |
WO2022050279A1 (ja) | 三次元計測装置 | |
US9613465B1 (en) | Method for suturing 3D coordinate information and the device using the same | |
KR20160045670A (ko) | 비행-시간 카메라 시스템 | |
WO2014174779A1 (ja) | 複数の光源を有するモーションセンサ装置 | |
US10055881B2 (en) | Video imaging to assess specularity | |
CN110716210A (zh) | 具有距离修正功能的测距装置 | |
JP2016075658A (ja) | 情報処理システムおよび情報処理方法 | |
JP5222430B1 (ja) | 寸法計測装置、寸法計測方法及び寸法計測装置用のプログラム | |
JP2023101522A (ja) | 撮像装置、情報処理装置、撮像方法、およびプログラム | |
US8436934B2 (en) | Method for using flash to assist in focal length detection | |
CN106683133B (zh) | 一种获取目标深度图像的方法 | |
JP2014070936A (ja) | 誤差画素検出装置、誤差画素検出方法、および誤差画素検出プログラム | |
US9978154B2 (en) | Distance measurement device base on phase difference and distance measurement method thereof | |
JP5482032B2 (ja) | 距離計測装置および距離計測方法 | |
US9791599B2 (en) | Image processing method and imaging device | |
KR102122275B1 (ko) | 배광 특성 측정 장치 및 배광 특성 측정 방법 | |
WO2014073590A1 (ja) | 3次元計測装置および3次元計測方法 | |
JP7206855B2 (ja) | 三次元位置検出装置、三次元位置検出システム、及び三次元位置検出方法 | |
US20190301855A1 (en) | Parallax detection device, distance detection device, robot device, parallax detection method, and distance detection method | |
JP5802917B2 (ja) | 距離画像カメラおよびこれを用いた距離測定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20140805 |