知財求人 - 知財ポータルサイト「IP Force」
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】6019621
(24)【登録日】2016年10月14日
(45)【発行日】2016年11月2日
(54)【発明の名称】距離計測装置
(51)【国際特許分類】
G01C 3/06 20060101AFI20161020BHJP
【ＦＩ】
G01C3/06 110A
G01C3/06 140
【請求項の数】6
【全頁数】15
(21)【出願番号】特願2012-45235(P2012-45235)
(22)【出願日】2012年3月1日
(65)【公開番号】特開2013-181806(P2013-181806A)
(43)【公開日】2013年9月12日
【審査請求日】2015年2月3日
(73)【特許権者】
【識別番号】000003997
【氏名又は名称】日産自動車株式会社
(74)【代理人】
【識別番号】100083806
【弁理士】
【氏名又は名称】三好 秀和
(74)【代理人】
【識別番号】100100712
【弁理士】
【氏名又は名称】岩▲崎▼ 幸邦
(74)【代理人】
【識別番号】100095500
【弁理士】
【氏名又は名称】伊藤 正和
(74)【代理人】
【識別番号】100101247
【弁理士】
【氏名又は名称】高橋 俊一
(74)【代理人】
【識別番号】100098327
【弁理士】
【氏名又は名称】高松 俊雄
(72)【発明者】
【氏名】沖 孝彦
【審査官】
神谷 健一
(56)【参考文献】
【文献】
特開２００８−０５１７５９（ＪＰ，Ａ）
【文献】
特開２００７−０９３３０６（ＪＰ，Ａ）
【文献】
特開２００８−２４１４３５（ＪＰ，Ａ）
(58)【調査した分野】（Int.Cl.，ＤＢ名）
Ｇ０１Ｂ１１／００−１１／３０
Ｇ０１Ｃ ３／００− ３／３２
Ｇ０１Ｓ ７／４８− ７／５１，
１７／００−１７／９５
(57)【特許請求の範囲】
【請求項1】
移動体に搭載され、水平方向に発光領域を有し強度変調された照射光を照射する投光手段と、
前記移動体に搭載され、前記照射光が照射された対象物を撮像する撮像手段と、
前記撮像手段の撮像のタイミングに合わせて前記投光手段より照射する照射光の発光強度を制御する投光制御手段と、
前記撮像手段にて撮像された画像から、前記照射光の発光の強度変調と同期して輝度変動する領域を、同期検波領域として抽出する同期検波処理手段と、
前記同期検波領域のエッジ部を検出するエッジ部検出手段と、
前記エッジ部検出手段にて検出されたエッジ部に基づいて、前記対象物までの距離を算出する距離算出手段と、を有し、
前記同期検波手段は、前記撮像手段で撮像された画像の輝度出力値が、該撮像手段の輝度感度特性が非線形領域で検出された場合には、この輝度出力値を前記撮像手段の輝度感度特性が線形領域で検出された輝度出力値を用いて補正すること
を特徴とする距離計測装置。
前記移動体に搭載され、前記照射光が照射された対象物を撮像する撮像手段と、
前記撮像手段の撮像のタイミングに合わせて前記投光手段より照射する照射光の発光強度を制御する投光制御手段と、
前記撮像手段にて撮像された画像から、前記照射光の発光の強度変調と同期して輝度変動する領域を、同期検波領域として抽出する同期検波処理手段と、
前記同期検波領域のエッジ部を検出するエッジ部検出手段と、
前記エッジ部検出手段にて検出されたエッジ部に基づいて、前記対象物までの距離を算出する距離算出手段と、を有し、
前記同期検波手段は、前記撮像手段で撮像された画像の輝度出力値が、該撮像手段の輝度感度特性が非線形領域で検出された場合には、この輝度出力値を前記撮像手段の輝度感度特性が線形領域で検出された輝度出力値を用いて補正すること
を特徴とする距離計測装置。
【請求項2】
前記同期検波処理手段は、前記投光手段より照射された照射光の変調周期の半分以上において、前記撮像手段の線形領域の出力値が観測されている場合に、前記非線形領域の出力値を補正することを特徴とする請求項１に記載の距離計測装置。
【請求項3】
前記同期検波処理手段は、前記非線形領域の輝度値が出力される時間の、変調周期全体に対する割合に応じて、直流オフセット成分を補正することを特徴とする請求項１または請求項２のいずれかに記載の距離計測装置。
【請求項4】
前記投光手段、及び前記撮像手段は、照射光の強度変調として、振幅変調、位相変調、周波数変調のうちの一つ、或いはこれらの組み合わせを用いることを特徴とする請求項１〜請求項３のいずれか１項に記載の距離計測装置。
【請求項5】
前記投光手段は、可視光、赤外光、紫外光のうちの少なくとも１つを照射する光源を具備し、前記撮像手段は、前記投光手段に具備された光源に応じて、可視光領域、赤外領域、紫外領域に感度を有することを特徴とする請求項１〜請求項４のいずれか１項に記載の距離計測装置。
【請求項6】
前記撮像手段は、前記投光手段の上端エッジが照射される方向に対して、鉛直方向に設けられ、且つ、所定の俯角を有することを特徴とする請求項１〜請求項５のいずれか１項に記載の距離計測装置。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、強度変調された照射光を対象物に照射して対象物までの距離を計測する距離計測装置に関する。
【背景技術】
【0002】
対象物に向けて照射光を照射し、この照射光の反射光をＣＣＤ等の撮像素子で撮像し、取得した撮像データに基づいて対象物までの距離、或いは対象物の形状を計測する光学式の距離計測装置が知られている。このような距離計測装置において、照射する光の反射光が背景光に比べて弱いと、反射光は背景光の雑音に埋もれてしまい、対象物を正しく認識できなくなる場合がある。
【0003】
そこで、従来より反射光が弱くなる遠方用の送受光部と、反射光が十分に強い近傍用の送受光部とで異なる波長や点滅周期にすることで、個別に計測できるようにした距離測定装置が提案されている（例えば、特許文献１参照）。
【先行技術文献】
【特許文献】
【0004】
【特許文献1】特開２０１０−１０７４４８号公報
【発明の概要】
【発明が解決しようとする課題】
【0005】
しかしながら、雑音に対する頑健性を高めるために正弦波等で強度変調された送信信号を用いて距離を測定する際に、背景光の光量が撮像素子の輝度感度特性における線形観測領域の上端部、或いは下端部付近に送信信号が重畳した反射光を観測する場合には、この反射光が撮像素子の非線形領域に入ってしまうことがある。
【0006】
このような場合には、撮像手段にて撮像した画像から取得される強度変調された信号の上端部（正弦波の上部ピーク領域）、或いは下端部（正弦波の下部ピーク領域）が飽和してしまい、送信信号に対して同期検波処理を実行する際の同期検波判定に誤りが生じ、十分な反射情報があるにも拘わらず、強度変調信号が非検出となってしまい、対象物までの距離計測や形状計測の精度が低下するという問題があった。
【0007】
本発明は、このような従来の課題を解決するためになされたものであり、その目的とするところは、撮像された画像から取得される強度変調信号が、撮像手段の輝度感度特性の非線形領域で検出される場合であっても対象物までの距離、形状を高精度に計測することが可能な距離計測装置を提供することにある。
【課題を解決するための手段】
【0008】
上記目的を達成するため、本発明は、強度変調された照射光を照射する投光手段と、照射光が照射された対象物を撮像する撮像手段と、撮像手段にて撮像された画像から、前記投光手段での発光の強度変調と同期して輝度変動する領域を同期検波領域として抽出する同期検波処理手段とを有する。そして、同期検波手段は、撮像手段で撮像された画像の輝度出力値が該撮像手段の輝度感度特性が非線形領域で検出された場合には、この輝度出力値を撮像手段の輝度感度特性が線形領域で検出された輝度出力値を用いて補正する。
【発明の効果】
【0009】
本発明に係る距離計測装置では、強度変調された照射光を用いて対象物までの距離を計測する際に、撮像手段の非線形領域の輝度出力値が一部観測される場合においても、照射光の同期検波計測を誤ることなく、安定した距離計測または形状計測を実施することができる。
【図面の簡単な説明】
【0010】
【図1】本発明の一実施形態に係る距離計測装置の構成を示すブロック図である。
【図2】本発明の一実施形態に係る距離計測装置の、同期検波処理部の詳細な構成を示すブロック図である。
【図3】本発明の一実施形態に係る距離計測装置の、同期検波処理部での処理手順を示す説明図である。
【図4】本発明の一実施形態に係る距離計測装置の、同期検波処理部における各信号の変化を示すタイミングチャートである。
【図5】本発明の一実施形態に係る距離計測装置により観測対象物までの距離を測定する様子を示す説明図である。
【図6】本発明の一実施形態に係る距離計測装置のカメラで撮像された画像を示す説明図である。
【図7】本発明の一実施形態に係る距離計測装置により、観測対象物までの距離を測定する原理を示す説明図である。
【図8】本発明の一実施形態に係る距離計測装置に用いられる撮像素子の、入力光強度と輝度出力値との対応を示す特性図である。
【図9】強度変調された信号に対して撮像素子の輝度出力信号の上端部に歪みを生じる様子を示す説明図である。
【図10】強度変調された信号に対して撮像素子の輝度出力信号の下端部に歪みを生じる様子を示す説明図である。
【図11】歪みが生じた輝度出力信号を補正する際の補正量を示す説明図である。
【図12】本発明の一実施形態に係る距離計測装置の、処理手順を示すフローチャートである。
【図14】本発明の一実施形態に係る距離計測装置によるカメラの俯角０°の場合の、距離分解能を示す説明図である。
【図15】本発明の一実施形態に係る距離計測装置によるカメラの俯角α°の場合の、距離分解能を示す説明図である。
【発明を実施するための形態】
【0011】
以下、本発明の実施形態を図面に基づいて説明する。図１は、本発明の一実施形態に係る距離計測装置１００の構成を示すブロック図である。図１に示すように、該距離計測装置１００は、車両（移動体）に搭載されるものであり、車両周囲の距離測定の対象となる観測対象物Ｐに向けて照射光を照射する投光部（投光手段）１１と、照射光が照射された観測対象物Ｐの映像を撮像するカメラ（撮像手段）１２と、投光部１１による照射光の照射を制御する投光制御部１４と、カメラ１２で撮像された画像信号に対して同期検波処理を加える同期検波処理部（同期検波処理手段）１３と、同期検波された画像から観測対象物Ｐの上端エッジを検出する上端エッジ検出部１５と、上端エッジ検出部１５で検出されたエッジに基づいて車両から観測対象物Ｐまでの距離を算出する距離算出部１６と、を備えている。
【0012】
なお、本実施形態では、移動体が車両である場合を例に挙げて説明するが、本発明はこれに限定されるものではなく、鉄道車両や船舶等の他の移動体についても適用することが可能である。また、本実施形態に係る距離計測装置１００は、例えば、中央演算ユニット（ＣＰＵ）や、ＲＡＭ、ＲＯＭ、ハードディスク等の記憶手段からなる一体型のコンピュータを用いて構成することができる。
【0013】
投光部１１は、例えば、プロジェクタヘッドライトやリフレクタを備えたヘッドライトであり、水平方向に発光領域を形成する配光特性を有する照射光を観測対象物Ｐに向けて照射する。そして、観測対象物Ｐに照射光を照射することにより、該観測対象物Ｐ上に、照射領域と非照射領域との輝度境界を鮮明に映し出すことができる。また、該投光部１１の発光源として、可視光、赤外光、或いは紫外光の発光源を用いることができる。
【0014】
カメラ１２は、ＣＣＤやＣＭＯＳ等の撮像素子を備えており、車両周囲の画像を撮像し、更にこれに加えて、投光部１１により照射された照射光が観測対象物Ｐで反射した反射光を受光する。
【0015】
投光制御部１４は、投光部１１より出射する照射光をＰＷＭ制御する際のパルス点灯及び消灯タイミングのトリガ信号を出力するとともに、カメラ１２による撮像タイミングのトリガ信号とシャッター時間の制御信号を出力している。また、ＰＷＭ制御で使用した搬送波（キャリア周波数）信号を同期検波処理部１３に出力している。
【0016】
同期検波処理部１３は、カメラ１２にて時系列的に撮像される画像を順次記憶し、記憶した画像中の全画素（或いは、画像中に処理領域を制限した場合は、画像処理領域中の全画素）において、投光制御部１４から出力される照射光に含まれる変調信号を同期検波することにより、照射光強度と同期して輝度変化する画素のみを抽出した照射光抽出画像を出力する。そして、この照射光抽出画像を上端エッジ検出部１５に出力する。なお、同期検波処理部１３の詳細な構成については、図２に示すブロック図を参照して後述する。
【0017】
上端エッジ検出部１５は、同期検波処理部１３により抽出された照射光抽出画像より、照射光の上端エッジ部の位置を検出し、その画像内の縦位置情報（図６に示す照射光の上端エッジｒ１の上下方向の位置情報）を出力する。
【0018】
距離算出部１６は、上端エッジ検出部１５より出力される上端エッジの縦位置情報に用いて、照射光上端エッジの照射方向と、カメラ１２の視軸がなす角度及びレイアウトに基づき、三角測量の原理により、照射光が照射されている周囲物体までの距離を算出する。この算出の手順については、図７を参照して後述する。
【0019】
図２は、同期検波処理部１３の詳細な構成を示すブロック図である。図示のように、同期検波処理部１３は、画像メモリ２１と、オフセット補正演算部２２と、直流成分除去処理部２３と、波形乗算部２４、及び同期検波判定部２５を備えている。
【0020】
画像メモリ２１は、カメラ１２で撮像される画像を、投光制御の変調周期に相当する枚数分だけ記憶する。
【0021】
オフセット補正演算部２２は、画像メモリ２１に記憶された画像中に撮像素子の非線形領域の輝度出力値の存在状況に応じて、該当する画素の直流オフセット成分を補正する処理を行う。また、後述する図１１に示すように、画像中の輝度出力値の上端部、或いは下端部で歪みが生じた場合には、この歪みを補正する処理を行う。
【0022】
直流成分除去処理部２３は、画像メモリ２１に記憶された画像から、オフセット補正後の直流オフセット成分を除去する処理を行う。
【0023】
波形乗算部２４は、直流成分除去処理部２３で直流成分が除去された画像の画素ごとに投光制御の変調信号を乗算する。
【0024】
同期検波判定部２５は、波形乗算部２４で変調信号が乗算された信号の正負判定により、投光の変調信号との同期判定を行う。
【0025】
次に、同期検波処理部１３における一般的な同期検波の基本原理を、図３に示す模式図、及び図４に示すタイミングチャートを参照して説明する。本実施形態に係る距離計測装置１００では、投光部１１より観測対象物Ｐに向けて照射光を照射し、該観測対象物Ｐで反射した反射光を検出する際に、照射した照射光を他の光と区別して検出する。この際、照射した照射光のみを頑健に検出する処理として、同期検波処理を用いている。
【0026】
本実施形態では、カメラ１２により撮像された画像の全画素、或いは処理領域として設定された画像領域中の全画素について、この同期検波処理を実施し、各画素にて照射光の抽出を行う。以下、図３，図４を参照して詳細に説明する。
【0027】
図３に示す送信信号Ｓ(t)（ｔは時間）は、図４（ａ）に示すように、一定の時間間隔で「１」「０」のいずれかに変化するバイナリ信号とする。この送信信号Ｓ(t)を送出する際に、該送信信号Ｓ(t)に対して十分高い周波数ωを持つ搬送波sin（ωｔ）を送信信号Ｓ(t)で位相変調して、ＢＰＳＫ（Binary Phase Shift Keying：二位相偏移変調）送信信号を生成する。具体的には、Ｓ(t)＝１の場合には、切替部３１を上側に切り替えて搬送波sin（ωｔ）をそのまま出力し、Ｓ(t)＝０の場合には、切替部３１を下側に切り替えて搬送波sin（ωｔ）を、π（１８０度）だけ位相をシフトした波形を出力する。
【0028】
その結果、図４（ｂ）に示す如くの位相変調された波形（Ｓ(t)＝０の場合には位相が１８０度シフトしている）の信号が生成され、投光部１１より周囲物体である観測対象物Ｐに向けて照射される（図３の符号ｑ１参照）。即ち、投光部１１より送出される変調信号は、「２×（Ｓ(t)−０．５）×sin（ωｔ）」で示されることになる。
【0029】
一方、観測対象物Ｐに照射された照射光は該観測対象物Ｐにて反射し（図３の符号ｑ２参照）、カメラ１２にて撮像される。そして、画像に含まれる変調信号は、ＤＣ成分が除去され、更に、乗算部にて搬送波sin（ωｔ）が乗じられる。変調信号に対して搬送波sin（ωｔ）を乗算すると、下記（１）式となる。
【0030】
Ａ×（Ｓ(t)−０．５）×sin（ωｔ）×sin（ωｔ） ＝ Ａ×（Ｓ（ｔ）−０．５）×（１−cos（２ωｔ））／２ …（１）
なお、Ａは反射の影響を含む定数である。
（１）式より、乗算部の出力信号は、周波数の和（ＤＣ成分）と差（２倍の高調波成分）の信号成分が混在した信号となる。即ち、図４（ｃ）に示すように、周波数が２倍となり、且つ、Ｓ(t)＝１のときにプラス側に振幅し、Ｓ(t)＝０のときにマイナス側に振幅する波形が得られる。
【0031】
その後、ＬＰＦ（低域通過フィルタ）を用いて高周数成分を除去することにより平滑化され、更に、正負判定することにより、図４（ｄ）に示すように、復号信号として、送信されたバイナリ信号Ｓ(t)を取り出すことができる。なお、上記では、検波信号としてＢＰＳＫ送信信号を用いる例について説明したが、これ以外の振幅変調、位相変調、周波数変調、或いはこれらの組み合わせを用いることも可能である。
【0032】
そして、図２に示す同期検波処理部１３は、図３，図４に示した原理に基づき、カメラ１２で撮像された画像を画像メモリ２１に記憶し、オフセット補正演算部２２にて、画像メモリ２１に記憶された画像中にカメラ１２の非線形領域の輝度出力値の存在状況に応じて、該当する画素の直流オフセット成分を補正する処理を行い、且つ、輝度出力値の歪みを補正する処理を行う。
【0033】
更に、直流成分除去処理部２３にて、画像メモリ２１に記憶された画像から、オフセット補正後の直流オフセット成分を除去する処理を行う。その後、波形乗算部２４にて、直直流成分が除去された画像の画素ごとに投光制御の変調信号を乗算する。更に、同期検波判定部２５にて、変調信号が乗算された信号の正負判定により、投光の変調信号との同期判定を行う。
【0034】
次に、投光部１１より投光される照射光（水平方向に発光領域を有する光）の投光パターンについて説明する。上述したように、車両に搭載される投光部１１は、投光領域の上端部に明暗が鮮明な水平パターンを有する照射光を照射する。以下、この配光パターンについて、図５，図６を参照して説明する。図５は、車両Ｑに搭載される投光部１１より、観測対象物Ｐに向けて照射光を照射する様子を示す説明図であり、図６は、照射光を観測対象物Ｐに照射した際の、カメラ１２により撮像された画像を示す図である。
【0035】
車両Ｑの姿勢が変化することや、観測対象物Ｐが移動することにより、車両Ｑと観測対象物Ｐとの間の相対的な位置関係に変化が生じる場合であっても、安定的に領域光を抽出するためには、検波に必要な時系列的な画像フレームにおいて、照射光が観測対象物Ｐ上の同一箇所に連続して観測される必要がある。
【0036】
現実的には、車両及び観測対象物Ｐの動きに制約を設けることはできないので、車両Ｑ及び観測対象物Ｐが任意の動きをした場合でも、安定した照射光抽出を実現するために十分な照射光の抽出領域を設定する必要がある。そこで、本実施形態では、図６に示すように、水平方向に広がる（水平方向に長い）発光領域を有する照射光を用いている。
【0037】
次に、領域光の上端エッジを用いて、観測対象物Ｐまでの距離を計測する原理について、図７に示す模式図を参照して説明する。図７に示すように、投光部１１より照射される領域光の広がり方向（横方向）とは垂直な方向（縦方向）にオフセットした位置に、カメラ１２が配置される。投光部１１から投光される領域光が観測対象物Ｐに照射され、カメラ１２では、観測対象物Ｐの表面で反射した領域光を撮像する。ここで、投光部１１の領域光上端部の照射角度（図７の例では０度）、投光部１１とカメラ１２との距離（高低差）Ｄｙ、カメラ１２の俯角αに基づき、観測対象物Ｐまでの距離Ｚに応じて、領域光の上端部が観測される上下方位βが変化する。従って、カメラ１２で観測される照射領域上端の上下位置ｙを用いて、三角測量の原理により観測対象物Ｐまでの距離Ｚを算出することができる。
【0039】
図８は、撮像素子の輝度感度特性を示す図であり、カメラ１２の撮像素子に入射する光強度（横軸）と、輝度出力値（縦軸）との関係を示している。観測対象物Ｐには、投光部１１より照射される照射光以外に、太陽光等の背景光が照射されており、この背景光の直流成分強度に応じて、カメラ１２で撮像される画像の入射光強度が変化する。
【0040】
そして、この背景光の直流成分が大きい場合（背景光Ｎ１の場合）で、この背景光に対して、強度変調された照射光の反射光（Ａ１）が重畳した場合には、入射光強度（カメラ１２で撮像される画像の輝度）は大きくなるので、カメラ１２に搭載される撮像素子の非線形領域Ｐ１での検出となり、該カメラ１２にて検出される輝度出力値は、波形（Ｂ１）のような上端部に歪みが生じる信号波形となる。
【0041】
一方、背景光の直流成分が小さい場合（背景光Ｎ２の場合）で、この背景光に対して、強度変調された照射光の反射光（Ａ２）が重畳した場合には、入射光強度は小さくなるので、撮像素子の非線形領域Ｐ２での検出となり、上記と同様にカメラ１２にて検出される輝度出力値は、波形（Ｂ２）のような下端部に歪みが生じる信号波形となる。
【0042】
図９は、上端部が歪んだ信号が観測される画素の時系列的な輝度変化を示す特性図である。図９に示す領域Ｃは、カメラ１２の非線形特性により飽和検出されたサンプル点群を示している。この受信波形が歪んだ状態では直流オフセット成分（＝Ａ／２；上記（１）式参照）を正確に得ることができず、同期検波演算を実施すると、前述した（１）式の演算後の正負判定によるバイナリ信号Ｓ（ｔ）の復元に誤りを生じてしまうことになる。即ち、図８に示す非線形領域Ｐ１，Ｐ２が存在することにより、カメラ１２で撮像される入射光の強度に対して、輝度出力値に歪みが生じるので（図９の領域Ｃが存在するので）、正確な同期検波処理ができなくなってしまう。
【0043】
また、図１０は、下端部が歪んだ信号が観測される画素の時系列的な輝度変化を示す特性図であり、やはり領域Ｃが飽和検出されている。そして、上述した図９と同様に、この領域Ｃにより、正確な同期検波処理ができなくなってしまう。
【0044】
本実施形態では、下記の手法によりカメラ１２の撮像素子の非線形領域Ｐ１，Ｐ２での信号歪みを補正することにより、高精度な同期検波処理を実行して距離計測の精度を向上させる。
【0045】
以下、上記の非線形領域での信号歪みを補正する方法について説明する。本実施形態では、カメラ１２で検出される強度変調信号に含まれるサンプル点群に、非線形領域の出力値が観測された場合で、そのサンプル点数が変調周期内のサンプル点数の半分以下である場合に、カメラ１２の撮像素子の線形領域で検出されているサンプル点群（図９の領域Ｄで検出されるサンプル点群）を用いて、図９の領域Ｃ内のサンプル点の輝度出力値に不足しているオーバーシュート量を演算して、各サンプル点の輝度出力値を補正する。そして、補正により取得される補正波形と搬送波とを用いて同期検波処理を実施することにより、非検出となることなく（同期検波不能となることなく）、同期検波処理を継続して実行できるようになる。
【0046】
以下、図１１を参照してサンプル点の輝度出力値を補正する処理について説明する。図１１に示すように、変調信号をＧ１、輝度出力をＧ２とし、変調信号の出力値（ＢＰＳＫ信号の振幅値）ｂ１，ｂ２，ｂ３に対する輝度出力値をそれぞれａ１，ａ２，ａ３とする。また、ａ１，ａ２は、線形領域内での輝度出力値であり、ａ３は、非線形領域での輝度出力値であり、輝度出力の補正値（オーバーシュート分）をΔａとする。すると、次の（２）式が成立する。
【0047】
（ａ２−ａ１）／（ｂ２−ｂ１）＝｛（ａ３＋Δａ）−ａ２｝／（ｂ３−ｂ２）…（２）
そして、（２）式を変形すると、次の（３）式が得られる。
【0048】
（ａ３＋Δａ）＝｛（ａ２−ａ１）・（ｂ３−ｂ２）／（ｂ２−ｂ１）｝＋ａ２…（３）
従って、「ａ３＋Δａ」は、上記（３）式で求めることができ、（３）式により、撮像素子の非線形領域で検出された輝度出力値を補正することができる。即ち、図８の符号Ｂ１，Ｂ２に示した輝度出力値を、歪みのない波形に補正することができる。この処理は、図２に示したオフセット補正演算部２２により演算される。
【0051】
初めに、ステップＳ１において、カメラ１２から画像を取得して画像メモリ２１（図２参照）に保存する。ステップＳ２において、同期検波に必要なフレーム数の画像が画像メモリ２１に保存されているか否かを判定し、同期検波に必要な画像数が保存されてなければ、ステップＳ１に処理を戻し、同期検波に必要な画像数が保存されていれば、ステップＳ３に移行する。
【0052】
ステップＳ３において、後述する同期検波処理を実行する。その後、ステップＳ４に移行する。ステップＳ４において、同期検出された領域の上端エッジを抽出し、ステップＳ５に移行する。
【0053】
ステップＳ５において、ステップＳ４の処理で検出された上端エッジのデータに基づき、三角測量による距離計測処理を行う。即ち、図７に示した手法に基づいて、観測対象物Ｐまでの距離を計測する。その後、ステップＳ６に移行する。
【0054】
ステップＳ６において、ステップＳ５の処理で求められた距離値を下位のシステムに出力する。その後、本処理を終了する。こうして、カメラ１２の取り付け位置から、観測対象物Ｐまでの距離を計測することができる。
【0055】
次に、ステップＳ３に示した同期検波処理の手順について、図１３に示すフローチャートを参照して説明する。
【0056】
初めに、ステップＳ１１において同期検波処理を開始し、ステップＳ１２において、画像メモリ２１に記憶されている画像から、同期検波に必要な枚数の時系列画像データを取得する。その後、ステップＳ１３に移行する。
【0057】
ステップＳ１３において、画素単位で時系列データ中に撮像素子の非線形領域に相当する輝度出力値が存在するか否かを判定し、存在すると判定された場合はステップＳ１４に移行し、存在しないと判定された場合にはステップＳ１６に移行する。
【0058】
ステップＳ１４において、非線形領域に相当する輝度出力が変調周期内の半数以下（５０％以下）であるか否か判定する。具体的には、図９の領域Ｃに示したサンプル点の個数が全体（１周期分）のサンプル点の個数の半数以下であるか否かを判定する。そして、半数以下と判定された場合には（ステップＳ１４でＹＥＳ）、ステップＳ１５において、線形領域の輝度出力値に基づいて振幅を補正する。具体的には、図１１に示した手法を用いてオーバーシュート分であるΔａを算出して、輝度出力値の振幅を補正する。その後、ステップＳ１６に移行する。
【0059】
ステップＳ１６において、画素単位での平均処理を行い、各画素の平均値を各時系列データから除算することでＤＣオフセット成分を除去する。その後、ステップＳ１７に移行する。ステップＳ１７において、オフセット調整された時系列データと搬送波とを乗算する。その後、ステップＳ１８に移行する。
【0060】
ステップＳ１８において、乗算後の結果の正負判定結果と送信信号Ｓ（ｔ）とが同期しているか否かを判定し、同期していればステップＳ１９に移行して、画素を同期色（例として、白色：８ｂｉｔ階調の場合は「２５５」）で上書きする。一方、同期していなければステップＳ２０に移行し、画素を非同期色（例として、黒色：８ｂｉｔ階調の場合は「０」）で上書きする。その後、ステップＳ２２に移行する。
【0061】
また、ステップＳ１４の処理で非線形領域の輝度出力数が全体の半数よりも大きいと判定された場合には、ステップＳ２１において、同期判定不可と色付け（例として、灰色：８ｂｉｔ階調の場合は「１２７」）して出力する。即ち、非線形領域の輝度出力数が全体の半数よりも大きい場合には、線形領域のデータを用いた補正が困難であるので、この場合には同期検波ができないものと判断する。その後、ステップＳ２２に移行する。
【0062】
ステップＳ２２において、全画素で判定が終了したか否かを判定し、終了していなければステップＳ１２に処理を戻し、終了していない画素について同期検波判断を実行する。一方、全画素の判定が終了していれば、ステップＳ２３に移行して同期検波画像を出力する。その後、本処理を終了する。
【0063】
次に、カメラ１２の視軸が、上端エッジが照射される方向に対して所定の俯角を有するように設定することにより、分解能を向上させることができることについて説明する。
【0064】
１個のカメラ１２で広域を観測するためには、通常、広角レンズが用いられる。一般的な広角レンズは、射影方式として等距離射影レンズ（いわゆる、ｆθレンズ）を採用しており、周辺視野では中心視野に比べて分解能が劣る。このような広角レンズとの組み合わせにおいては、カメラ視軸に俯角（或いは仰角）を持たせ、分解能が高い領域を監視したい領域に向けて適切に設定することが肝要となる。
【0065】
以下、ｆθレンズとの組み合せにおいて、簡単のために、照射光の上端エッジが路面に対して水平である場合を仮定し、カメラ視軸の俯角がある場合に、被観測対象までの距離計測値の分解能が向上することを、図１４，図１５を参照して説明する。カメラ視軸に俯角が無い場合を図１４に示し、俯角が有る場合を図１５に示す。
【0066】
図１４，図１５で、視軸方向の画素位置をｙ（ｊ）とし、ｙ(ｊ）の下に隣接する画素位置をｙ（ｊ＋１）とする。このとき、図１４に示すように、俯角（仰角）が０度の場合において、画素位置ｙ（ｊ）とｙ（ｊ＋１）で決定される１画素の角度分解能は、実空間距離での距離分解能ｄＤ（０）であるとする。一方、図１５に示すように、俯角（仰角）がα度の場合において、画素位置ｙ（ｊ）とｙ（ｊ＋１）で決定される１画素の角度分解能は、実空間距離での距離分解能ｄＤ（α）であるとする。この場合、ｄＤ（α）＜ｄＤ（０）が成立するので、カメラ視軸に俯角（仰角）を持たせた場合、１画素の角度分解能に対する実空間分解能が高くなる。即ち、俯角αを設けることにより、上端エッジを抽出する際の実空間分解能を高くすることが可能となる。
【0067】
このように、投光部１１により投光される領域光の上端エッジは、カメラ１２に対して横方向に領域が形成され、カメラ１２は上端エッジ照射方向に対して鉛直な方向にオフセットして配置されると共に、上端エッジ照射方向と視軸が所定角度をなすようにすれば、一般的な広角レンズ（魚眼レンズ）を使用した際においても、三角測量の原理に基づき距離計測する際の計測精度が向上する。
【0068】
このようにして、本実施形態に係る距離計測装置では、投光部１１から検出対象領域（観測対象物Ｐを含む領域）に向けて、所定の変調周波数で強度変調した照射光を照射し、更に、検出対象領域で反射した反射光をカメラ１２にて撮像し、撮像した画像を時系列的に画像メモリ２１に記憶保存する。そして、時系列的に撮像された画像データに基づいて同期検波処理を行い、照射光に同期した画素の輝度情報を抽出する。この際、カメラ１２に搭載される撮像素子の、非線形領域で検出された輝度信号は波形に歪みが発生する場合がある。
【0069】
即ち、照射光の変調周期内に、カメラ１２の撮像素子から出力される撮像信号の上端部（上部ピーク値）、或いは下端部（下部ピーク値）が撮像素子の輝度感度特性の線形領域の上端部以上（図８の領域Ｐ１）、或いは下端部以下（図８の領域Ｐ２）となる場合があり、このような場合には輝度信号の波形に歪みが生じてしまい、同期検波の精度が低下する。本実施形態では、線形領域部分の輝度変化を用いて非線形領域の輝度情報を補正することにより、カメラ１２による撮像信号の一部に歪みが発生した状況においても、同期検波処理において高精度な同期検出を行うことができ、安定した距離計測、及び形状計測を行うことが可能となる。
【0070】
また、非線形領域の観測時間が照射光の変調周期の半分以下である場合（換言すれば、線形領域の観測時間が照射光の変調周期の半分以上である場合）に、非線形領域の出力値の補正を実施するので、同期判定において誤判定を発生することなく安定した照射光抽出を実施することができる。また、非線形領域の観測時間が照射光の変調周期の半分以下でない場合には、判定を行わず、図１３のステップＳ２１に示したように、判定不可色で表示するので、判定不可である領域を利用者に対して確実に認識させることができる。
【0071】
また、投光部１１により照射される照射光の上端エッジは、カメラ１２に対して横方向に領域が形成され、カメラ１２は上端エッジ照射方向に対して鉛直な方向にオフセットして配置されると共に、上端エッジ照射方向とカメラ１２の視軸が所定角度をなすので、一般的な広角レンズ（魚眼レンズ）を使用した際においても、三角測量の原理に基づき距離計測する際の計測精度が向上する。
【0072】
更に、投光部１１に具備される発光源が、赤外光、或いは紫外光を発するようにすれば、カメラ１２に特定スペクトルの光を高効率で透過するフィルタを設けることにより、照射光をより頑健に検出することが可能となる。
【0073】
また、投光部１１、及び同期検波処理部１３で用いる同期信号として、振幅変調や位相変調、周波数変調を用いることも可能であり、更に、振幅変調と位相変調の組み合わせであるＢＰＳＫなどを用いることで、頑健性を向上させることが可能である。
【0074】
次に、上述した実施形態の変形例について説明する。簡易的な方法として、観測される輝度出力値の平均処理により得られる直流オフセット成分（＝Ａ／２）を、輝度出力値内に存在する非線形領域の出力値の割合に応じて、オフセット量の補正をすることでも、同様の効果を得ることができる。
【0075】
例えば、変調周期中のＮ［％］に高輝度域での非線形領域の出力値が存在すると検出された場合には、Ｎ／２［％］だけ増加したオフセット量（＝（１＋Ｎ/２００）×Ａ／２）に補正することで、同期検波処理において誤りを生じることなく、安定した距離計測を実施することができる。ここで、Ｎ［％］は５０％以下の状態で補正を実施することで、誤同期を防ぐことができる。
【0076】
以上、本発明の距離計測装置を図示の実施形態に基づいて説明したが、本発明はこれに限定されるものではなく、各部の構成は、同様の機能を有する任意の構成のものに置き換えることができる。
【産業上の利用可能性】
【0077】
本発明は、撮像素子の非線形領域での輝度出力値を補正して高精度な距離計測に利用することができる。
【符号の説明】
【0078】
１１ 投光部１２ カメラ
１３ 同期検波処理部
１４ 投光制御部
１５ 上端エッジ検出部
１６ 距離算出部
２１ 画像メモリ
２２ オフセット補正演算部
２３ 直流成分除去処理部
２４ 波形乗算部
２５ 同期検波判定部
３１ 切替部
１００ 距離計測装置
Ｐ 観測対象物