(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2024-02-13
(45)【発行日】2024-02-21
(54)【発明の名称】測距装置
(51)【国際特許分類】
G01S 7/487 20060101AFI20240214BHJP
G01C 3/06 20060101ALI20240214BHJP
G01S 17/10 20200101ALI20240214BHJP
【FI】
G01S7/487
G01C3/06 120Q
G01S17/10
(21)【出願番号】P 2023018767
(22)【出願日】2023-02-09
(62)【分割の表示】P 2020125653の分割
【原出願日】2020-07-22
【審査請求日】2023-02-09
(31)【優先権主張番号】P 2019163207
(32)【優先日】2019-09-06
(33)【優先権主張国・地域又は機関】JP
(31)【優先権主張番号】P 2019177385
(32)【優先日】2019-09-27
(33)【優先権主張国・地域又は機関】JP
(31)【優先権主張番号】P 2020013600
(32)【優先日】2020-01-30
(33)【優先権主張国・地域又は機関】JP
(73)【特許権者】
【識別番号】000004260
【氏名又は名称】株式会社デンソー
(74)【代理人】
【識別番号】110000578
【氏名又は名称】名古屋国際弁理士法人
(72)【発明者】
【氏名】藤澤 貴祥
(72)【発明者】
【氏名】植野 晶文
(72)【発明者】
【氏名】尾崎 憲幸
【審査官】梶田 真也
(56)【参考文献】
【文献】特開2019-015522(JP,A)
【文献】特開2013-164385(JP,A)
【文献】特開2007-327840(JP,A)
【文献】特開2019-095353(JP,A)
【文献】特開2017-125682(JP,A)
【文献】特開2019-002760(JP,A)
【文献】特開平10-253760(JP,A)
【文献】特開平11-160432(JP,A)
【文献】特開平07-072237(JP,A)
【文献】特表2011-505545(JP,A)
【文献】米国特許出願公開第2007/0255525(US,A1)
(58)【調査した分野】(Int.Cl.,DB名)
G01S 7/48 - 7/51
G01S 17/00 - 17/95
G01C 3/00 - 3/32
(57)【特許請求の範囲】
【請求項1】
物体に光を照射する発光部(2)と、
前記発光部から照射された光である照射光を反射した前記物体からの反射光を少なくとも受光する受光部(3)と、
前記受光部で取得される受光光量の時間変化を受光情報とし、前記発光部が照射を繰り返すことで得られる複数の前記受光情報から、一次閾値及び二次閾値を設定する特性設定部(7j,7n~7p)と、
前記受光情報を複数回の発光にわたり前記照射光の発光タイミングを一致させた時間軸上で積算した積算受光情報を生成する受光積算部(6)と、
前記積算受光情報によって表される積算受光波形に含まれる前記一次閾値より大きいピーク値を有したパルス状の波形のそれぞれを検出対象とし、前記パルス状の波形から得られるタイミングを受光タイミングとして、前記発光タイミングから前記受光タイミングまでの時間差から前記照射光を反射した前記物体までの距離である物体距離、及び該物体距離に対応する前記パルス状の波形における受光量のピーク値であるエコーピーク値を含んだエコー情報を前記検出対象毎に生成する測距部(81j)と、
前記測距部で生成された前記エコー情報を、前記二次閾値を用いて有効化又は無効化するフィルタリング部(82j,82o,82p)と、
を備え、
前記特性設定部は、
前記受光積算部での積算対象となった複数の前記受光情報を対象情報群として、前記対象情報群に属する前記受光情報のそれぞれのベースラインの値である個別ベースライン値、及び前記積算受光情報のベースラインの値である積算ベースライン値を算出し、さらに前記個別ベースライン値のばらつき又は前記積算ベースライン値のばらつきのうちいずれか一方を用いて許容ばらつき値を算出するベースライン算出部(73)と、
前記対象情報群に属する前記受光情報のそれぞれについて、前記受光情報の少なくとも一部の時間範囲内での受光光量の最大値である生ピーク値、及び前記生ピーク値から前記個別ベースライン値を減算した相対ピーク値のうち少なくとも一方を算出するピーク算出部(74)と、
前記積算ベースライン値、及び前記許容ばらつき値を用いて前記一次閾値を設定する一次閾値設定部(755)と
前記対象情報群に属する前記受光情報のそれぞれについて算出された前記相対ピーク値の中での最大値である最大相対ピーク値、前記対象情報群に属する前記受光情報のそれぞれについて算出された前記生ピーク値の中での最大値である最大生ピーク値、及び前記積算ベースライン値のいずれかを少なくとも用いて前記二次閾値を設定する二次閾値設定部(756,756o)と、
を備える測距装置。
【請求項2】
請求項1に記載の測距装置であって、
前記フィルタリング部は、前記二次閾値以下の前記エコーピーク値を有する前記エコー情報を、無効エコー情報として抽出又は除去することで無効化する
測距装置。
【請求項3】
請求項1に記載の測距装置であって、
前記フィルタリング部は、前記二次閾値より大きい前記エコーピーク値を有する前記エコー情報を、有効エコー情報として抽出することで有効化する
測距装置。
【請求項4】
請求項3に記載の測距装置であって、
前記二次閾値設定部は、前記受光情報毎に抽出される最大受光光量によって複数の前記二次閾値を設定し、
前記フィルタリング部は、前記エコーピーク値と前記二次閾値とを値が大きい順、及び
小さい順のどちらか一方に組み合わせて、それぞれの大小関係を比較することで、前記有効エコー情報を抽出する
測距装置。
【請求項5】
請求項3または請求項4に記載の測距装置であって、
前記測距部で生成された前記エコー情報の数である検出エコー数が0より大きく、且つ前記フィルタリング部で抽出された前記有効エコー情報の数である有効エコー数が0である場合に、前記エコー情報の中に干渉波に基づく情報が含まれていることを示す干渉ありとの判定、及び、前記有効エコー情報の数が1以上である場合に、前記有効エコー情報に、干渉波に基づく情報が含まれていないことを示す干渉なしとの判定のうち、少なくとも一方を行う検知判定部(85)
を更に備える測距装置。
【請求項6】
請求項3または請求項4に記載の測距装置であって、
前記測距部で生成された前記エコー情報の数である検出エコー数が0より大きく、且つ前記フィルタリング部で抽出された前記有効エコー情報の数である有効エコー数が0である場合に、未検知の物体が存在する可能性があるとの判定、及び、前記有効エコー情報の数が1以上である場合に、物体が適切に検知されたとの判定のうち、少なくとも一方を行う検知判定部(85)
を更に備える測距装置。
【請求項7】
請求項6に記載の測距装置であって、
前記特性設定部は、
前記受光情報間で最大受光光量が得られるタイミング差を算出し、予め設定された固定値、及び前記積算ベースライン値に応じて設定される可変値のいずれか一方を判定閾値として、前記タイミング差が前記判定閾値よりも大きくなる回数であるピークばらつき回数を算出するピークばらつき算出部(76)を更に備え、
前記検知判定部は、前記ピークばらつき回数が予め設定されたばらつき閾値以下である場合に、物体が適切に検知されたとの判定を行う
測距装置。
【請求項8】
請求項3から請求項6までのいずれか1項に記載の測距装置であって、
前記測距部で検出される前記エコー情報の数である検出エコー数が1より大きく、且つ前記フィルタリング部で抽出される前記有効エコー情報の数である有効エコー数が0である場合、前記エコーピーク値が予め設定された無効条件を充足する前記エコー情報以外の全ての前記エコー情報を前記有効エコー情報として抽出する有効エコー抽出部(86)
を更に備える測距装置。
【請求項9】
請求項8に記載の測距装置であって、
前記無効条件として、前記エコーピーク値が最大であることを用いる
測距装置。
【請求項10】
請求項8に記載の測距装置であって、
前記無効条件として、最大の前記エコーピーク値から、前記積算ベースライン値の許容ばらつき分を減じた値を無効閾値として、前記エコーピーク値が前記無効閾値以上であることを用いる
測距装置。
【請求項11】
請求項8から請求項10までのいずれか1項に記載の測距装置であって、
前記特性設定部は、
前記受光情報間で最大受光光量が得られるタイミング差を算出し、予め設定された固定値、及び前記積算ベースライン値に応じて設定される可変値のいずれか一方を判定閾値として、前記タイミング差が前記判定閾値よりも大きくなる回数であるピークばらつき回数を算出するピークばらつき算出部(76)を更に備え、
前記有効エコー抽出部は、前記ピークばらつき回数が予め設定されたばらつき閾値以下である場合に、前記有効エコー情報の抽出を実行する
測距装置。
【請求項12】
請求項1から請求項11までのいずれか1項に記載の測距装置であって、
前記特性設定部は、
前記対象情報群に属する前記受光情報のそれぞれについて算出される前記相対ピーク値の合計値に、前記積算ベースライン値を加算した比較値を設定する比較値設定部(77)を更に備え、
前記フィルタリング部は、前記比較値と、前記エコーピーク値の中での最大値との差が予め設定された閾値より
小さい場合、
前記測距部で生成された前記エコー情報を、前記二次閾値を用いて有効化又は無効化する処理を実行する
測距装置。
【請求項13】
請求項1から請求項11までのいずれか1項に記載の測距装置であって、
前記特性設定部は、
前記対象情報群に属する前記受光情報のそれぞれについて算出される前記個別ベースライン値の中での最大値を比較値として設定する比較値設定部(77)を更に備え、
前記フィルタリング部は、前記エコー情報の中で前記エコーピーク値が最大となる最大エコーピーク値が前記比較値より小さい場合、
前記測距部で生成された前記エコー情報を、前記二次閾値を用いて有効化又は無効化する処理を禁止する
測距装置。
【請求項14】
請求項1から請求項13までのいずれか1項に記載の測距装置であって、
前記受光積算部は、前記積算ベースライン値
分をオフセットとして、当該オフセットを取り除いた前記積算受光情報を算出する
測距装置。
【請求項15】
請求項1から請求項13までのいずれか1項に記載の測距装置であって、
前記受光積算部は、前記積算ベースライン値
を含んだ前記積算受光情報を算出する
測距装置。
【請求項16】
請求項1から請求項15までのいずれか1項に記載の測距装置であって、
前記ピーク算出部は、少なくとも前記相対ピーク値を算出し、
前記二次閾値設定部は、
前記対象情報群に属する前記受光情報のそれぞれについて算出された前記
最大相対ピーク
値に、前記積算ベースライン値を加算した結果を前記二次閾値として設定する最大抽出部(751)を備える、
測距装置。
【請求項17】
請求項1から請求項15までのいずれか1項に記載の測距装置であって、
前記ピーク算出部は、少なくとも前記生ピーク値を算出し、
前記二次閾値設定部は、
前記対象情報群に属する前記受光情報のそれぞれについて算出され
る前記最大生ピーク値の抽出元となった前記受光情報の前記個別ベースライン値及び前記対象情報群に属する前記受光情報のそれぞれについて算出される前記個別ベースライン値の平均値のうちいずれか一方をオフセット値として、
前記最大生ピーク値から前記オフセット値を減算し、更に、前記積算ベースライン値を加算した結果を、前記二次閾値として設定する最大抽出部(751)を備える
測距装置。
【請求項18】
請求項15に記載の測距装置であって、
前記ピーク算出部は、少なくとも前記生ピーク値を算出し、
前記二次閾値設定部は、
前記対象情報群に属する前記受光情報のそれぞれについて算出される前
記最大生ピーク値を、前記二次閾値として設定する最大抽出部(751)を備える
測距装置。
【請求項19】
請求項16から請求項18までのいずれか1項に記載の測距装置であって、
前記二次閾値設定部は、予め指定された定数、及び前記ベースライン算出部又は前記ピーク算出部での算出結果に応じて設定される値のうちいずれか一方であるマージンを加算した前記二次閾値を設定する
測距装置。
【請求項20】
請求項16から請求項19までのいずれか1項に記載の測距装置であって、
前記ベースライン算出部は、前記個別ベースライン値と前記積算ベースライン値とに加えて、該個別ベースライン値のばらつき又は該積算ベースライン値のばらつきのうちいずれか一方を用いて許容ばらつき値を算出し、
前記二次閾値設定部は、
前記許容ばらつき値と、前記積算ベースライン値とを加算するばらつき算出部(753)と、
前記最大抽出部での演算結果と、前記ばらつき算出部での演算結果と、予め設定された固定値とのうち、最大値を選択して、前記二次閾値として設定する閾値選択部(754)と、
を更に備える、
測距装置。
【請求項21】
請求項1から請求項20までのいずれか1項に記載の測距装置であって、
前記発光部は、1又は複数回の照射毎に前記発光タイミングを変化させるように構成された
測距装置。
【請求項22】
請求項1から請求項21までのいずれか1項に記載の測距装置であって、
前記発光部は、複数の照射方向に向けて発光し、且つ、前記照射方向毎に前記発光タイミングの間隔が異なるように構成された
測距装置。
【発明の詳細な説明】
【技術分野】
【0001】
本開示は、光を用いて光を反射した物体との距離を測定する技術に関する。
【背景技術】
【0002】
光を照射し、物体からの反射光を受光することで、照射から受光までの光の飛翔時間(以下、TOF)を計測し、その計測されたTOFから光を反射した物体までの距離を求める測距装置が知られている。TOFは、Time Of Flightの略である。
【0003】
下記特許文献1には、光検知器として、複数のSPADを配列したSPADアレイを用いる測距装置が記載されている。なお、SPADは、Single Photon Avalanche Diodeの
略であり、ガイガーモードで動作する高感度なアバランシェフォトダイオードである。
【0004】
SPADアレイを用いた光検知器では、個々のSPADから出力されるパルス信号の数(以下、応答数)をカウントし、そのカウント値の時系列によって表される波形を受光波形として検出する。また、計測を繰り返し実施し、受光波形を積算することで、SPADアレイに入射する外乱光等の影響を抑制することも行われている。
【先行技術文献】
【特許文献】
【0005】
【発明の概要】
【発明が解決しようとする課題】
【0006】
しかしながら、発明者の詳細な検討の結果、特許文献1に記載の従来技術では、以下の課題が見出された。
すなわち、例えば、測距装置が車両に搭載されている場合、他の車両に搭載された測距装置からの照射光を受光した場合に、これが物体として誤検出される可能性があった。すなわち、TOFでは、受光波形中に表れるパルス状の波形から受光タイミングを求めるため、他の測距装置からの照射光の受光タイミングでパルス状の波形が表れる。このようなパルス状の波形は、検出が単発的であったとしても、受光強度が強いため、通常のノイズとは異なり積算による抑制効果が充分に得られず、ターゲットからの反射であると誤認識される場合があった。なお、車両に搭載されていない他の測距装置からの照射光、いわゆる干渉光を受光した場合にも、同様の問題が生じる。
【0007】
本開示の1つの局面は、パルス状の干渉光による誤検出を抑制する技術を提供することにある。
【課題を解決するための手段】
【0008】
本開示の一態様は、測距装置であって、発光部(2)と、受光部(3)と、特性設定部(7j,7n~7p)と、受光積算部(6)と、測距部(81j)と、フィルタリング部(82j,82o,82p)と、を備える。発光部は、物体に光を照射する。受光部は、発光部から照射された光である照射光を反射した物体からの反射光を少なくとも受光する。特性設定部は、受光部で取得される受光光量の時間変化を受光情報とし、発光部が照射を繰り返すことで得られる複数の受光情報から、一次閾値及び二次閾値を設定する。受光積算部は、受光情報を複数回の発光にわたり照射光の発光タイミングを一致させた時間軸上で積算した積算受光情報を生成する。測距部は、積算受光情報によって表される積算受光波形に含まれる一次閾値より大きいピーク値を有したパルス状の波形のそれぞれを検出
対象とし、パルス状の波形から得られるタイミングを受光タイミングとして、発光タイミングから受光タイミングまでの時間差から照射光を反射した物体までの距離である物体距離、及び該物体距離に対応するパルス状の波形における受光量のピーク値であるエコーピーク値を含んだエコー情報を検出対象毎に生成する。フィルタリング部は、測距部で生成されたエコー情報を、二次閾値を用いて有効化又は無効化する。
【0009】
特性設定部は、ベースライン算出部(73)と、ピーク算出部(74)と、一次閾値設定部(755)と二次閾値設定部(756,756o)と、を備える。ベースライン算出部は、受光積算部での積算対象となった複数の受光情報を対象情報群として、対象情報群に属する受光情報のそれぞれのベースラインの値である個別ベースライン値、及び積算受光情報のベースラインの値である積算ベースライン値を算出し、さらに個別ベースライン値のばらつき又は積算ベースライン値のばらつきのうちいずれか一方を用いて許容ばらつき値を算出する。ピーク算出部は、対象情報群に属する受光情報のそれぞれについて、受光情報の少なくとも一部の時間範囲内での受光光量の最大値である生ピーク値、及び生ピーク値から個別ベースライン値を減算した相対ピーク値のうち少なくとも一方を算出する。一次閾値設定部は、積算ベースライン値、及び許容ばらつき値を用いて一次閾値を設定する。二次閾値設定部は、個別ベースライン値及び積算ベースライン値のうち少なくとも一方、並びに生ピーク値及び相対ピーク値のうち少なくとも一方を用いて二次閾値を設定する。
【0010】
このような構成によれば、複数の受光情報を積算した積算受光情報を用いて物体までの距離が算出されるため、積算受光情報によって表される受光波形において照射光以外のパルス光により生じるパルス状の波形の受光光量が抑制される。
【0011】
また、このような構成によれば、一次閾値を用いて、積算受光情報からエコー情報を生成し、更に、二次閾値を用いて有効エコー情報が抽出される。従って、干渉光波形に基づく誤検出、すなわち物体が存在しないにも関わらず距離が検出されることを抑制できると共に、干渉光波形に対して測距処理が行われることが抑制されるため、測距部での処理負荷を軽減できる。
【図面の簡単な説明】
【0012】
【
図2】発光タイミングと受光波形との関係を示す説明図である。
【
図3】受光波形を二値化する処理、受光波形を積算する処理、及び二値化波形を積算する処理の概要を示す説明図である。
【
図4】ターゲットの存在と受光波形との関係を示す説明図である。
【
図5】他の測距装置から照射光を受光した場合の受光波形を示す説明図である。
【
図6】二値化波形の積算値とフィルタ特性との関係を示す説明図である。
【
図7】距離算出部での処理の概要を示す説明図である。
【
図8】第2参考形態における測距装置の構成を示すブロック図である。
【
図9】受光波形を二値化する処理、受光波形を積算する処理、及び二値化波形の論理積を演算する処理の概要を示す説明図である。
【
図10】第3参考形態における測距装置の構成を示すブロック図である。
【
図11】第3参考形態における距離算出部での処理の概要を示す説明図である。
【
図12】第3参考形態の変形例を示すブロック図である。
【
図13】第4参考形態における測距装置の構成を示すブロック図である。
【
図14】二値化波形を正規化する処理の概要を示す説明図である。
【
図15】第4参考形態における距離算出部での処理の概要を示す説明図である。
【
図16】第5参考形態における測距装置の構成を示すブロック図である。
【
図17】第5参考形態における閾値設定部での処理の概要を示す説明図である。
【
図18】第6参考形態における測距装置の構成を示すブロック図である。
【
図19】第7参考形態における測距装置の構成を示すブロック図である。
【
図20】第7参考形態における閾値設定部での処理の概要を示す説明図である。
【
図21】第8参考形態の測距装置の構成を示すブロック図である。
【
図22】第9参考形態の測距装置の構成を示すブロック図である。
【
図23】受光波形を二値化する処理の変形例、受光波形を積算する処理、及び二値化波形を積算する処理の概要を示す説明図である。
【
図24】受光波形を二値化する処理の変形例、受光波形を積算する処理、及び二値化波形の論理積を演算する処理の概要を示す説明図である。
【
図25】第1実施形態における測距装置の構成を示すブロック図である。
【
図26】第1実施形態における測距部での処理の概要を示す説明図である。
【
図27】第1実施形態における閾値フィルタリング部での処理を示すフローチャートである。
【
図28】第2実施形態における測距装置の構成を示すブロック図である。
【
図29】第2実施形態における検知判定部での処理を示すフローチャートである。
【
図30】第2実施形態における検知判定部での処理の概要を示す説明図である。
【
図31】第3実施形態における測距装置の構成を示すブロック図である。
【
図32】第3実施形態における有効エコー抽出部での処理を示すフローチャートである。
【
図33】第3実施形態における有効エコー抽出部での処理の変形例を示すフローチャートである。
【
図34】第4実施形態における測距装置の構成を示すブロック図である。
【
図35】第5実施形態における測距装置の構成を示すブロック図である。
【
図36】第5実施形態におけるピークばらつき算出部での処理を示すフローチャートである。
【
図37】第5実施形態におけるピークばらつき算出部での処理の概要を示す説明図である。
【
図38】第5実施形態における検知判定部での処理を示すフローチャートである。
【
図39】第6実施形態における測距装置の構成を示すブロック図である。
【
図40】第6実施形態におけるフィルタリング部での処理を示すフローチャートである。
【
図41】減算後積算方法により積算受光情報を算出する手順の概要を示す説明図である。
【
図42】積算後減算方法により積算受光情報を算出する手順の概要を示す説明図である。
【
図43】順次積算方法により積算受光情報を算出する手順の概要を示す説明図である。
【
図44】第2実施形態の変形例における検知判定部での処理を示すフローチャートである。
【
図45】第7実施形態において想定する状況についての説明図である。
【
図46】第7実施形態における測距装置の構成を示すブロック図である。
【
図47】干渉光ピークが含まれない場合における各受光情報及び積算受光情報を示す説明図である。
【
図48】各受光情報に含まれる干渉光ピークがいずれも反射光ピークより小さい場合における各受光情報及び積算受光情報を示す説明図である。
【
図49】各受光情報に含まれる干渉光ピークがいずれも反射光ピークより大きい場合における各受光情報及び積算受光情報を示す説明図である。
【
図50】受光情報に含まれる干渉光ピークが反射光ピークより大きい場合における各受光情報及び積算受光情報を示す説明図である。
【
図51】第7実施形態の変形例における各受光情報、中間積算情報、及び積算受光情報を示す説明図である。
【
図52】測距装置が複数の発光部を備え、各発光部が異なる方向に光を照射することを示す説明図である。
【
図53】二つの発光部のそれぞれにおいて出力周期をランダムに変化させたときの発光タイミングを示す説明図である。
【
図54】二つの発光部のそれぞれにおいて一定の出力周期で発光させ、発光部毎に出力周期を異ならせたときの発光タイミングを示す説明図である。
【
図55】距離算出部の変形例の構成を示すブロック図である。
【
図56】
図55に示す距離算出部での処理の概要を示す説明図である。
【
図57】距離算出部の変形例の構成を示すブロック図である。
【
図58】
図57に示す距離算出部での処理の概要を示す説明図である。
【発明を実施するための形態】
【0013】
以下、図面を参照しながら、本開示の実施形態及び参考形態について説明する。
[1.第1参考形態]
[1-1.構成]
図1に示す測距装置1は、車両に搭載して使用され、光を照射し、照射した光を反射する物体からの反射光を受光することで、計測される物体までの光の往復時間から距離を計測する、いわゆるライダー装置である。ライダーはLIDARとも表記される。LIDARは、Light Detection and Rangingの略語である。
【0014】
測距装置1は、
図1に示すように、発光部2と、受光部3と、タイミング制御部4と、処理部5とを備える。
発光部2は、一つ以上の発光素子を有し、タイミング制御部4からの発光トリガ信号に従って、パルス状のレーザ光を繰り返し照射する。発光素子としては、例えば、レーザダイオードが用いられる。
【0015】
受光部3は、2次元的に配列された複数のSPADと光検出器とを備える。SPADは、Single Photon Avalanche Diodeの略である。SPADは、ガイガーモードで動作する
アバランシェフォトダイオード(以下、APD)である。ガイガーモードは、APDに、ブレイクダウン電圧よりも高い逆バイアス電圧を印加して動作させる動作モードである。SPADはフォトンの入射によりブレイクダウンする。光検出器は、SPADがブレイクダウンしたときの電圧変化を検出して、所定パルス幅のデジタルパルスを出力し、予め設定された単位時間毎に検出されるパルス数を集計する。これにより、発光タイミングを開始時刻とした一定期間の受光光量をサンプリングした、時間と光量の関係を表す受光情報を生成する。なお、受光情報によって表される波形を受光波形という。
【0016】
タイミング制御部4は、
図2に示すように、発光トリガ信号を繰り返し出力する。但し、発光トリガ信号の出力周期T1,T2,T3,…は、一定ではなく、一定の範囲内でランダムに変化させる。一定の範囲とは、当該測距装置1の最大検知距離を光が往復するのに要する時間Tmaxをより長く設定され、かつ、後述する積算の対象となる複数の受光情報が、同じ位置にある物体について計測されたと見なせる範囲で設定される。
図2では、予め設定された基準時間をTf、Tmax<5Tfとして、基準時間Tf単位で周期を変化させている。以下では、発光トリガ信号が出力されるタイミングを、発光タイミングという。
【0017】
図1に戻り、処理部5は、受光積算部6と、特性設定部7と、距離算出部8とを備える。
受光積算部6は、受光部3から供給される連続するM回の発光タイミングのそれぞれで、得られたM個の受光情報を、
図3に示すように、発光タイミングを起点とする時間合わ
せを行って積算する。
図3は、M=3の場合を示す。受光積算部6にて積算の対象となるM個の受光情報を対象情報群という。受光積算部6にて積算された結果を積算受光情報、積算受光情報によって表される波形を積算受光波形という。積算受光情報は、距離算出部8に供給される。
【0018】
なお、
図3及び
図4に示すように、実際に物体が存在する場合、M個の受光情報にて示される受光波形のすべてに、同じ物体からの反射光に基づくパルス状の波形(以下、反射光波形)が、発光タイミングを起点とする時間軸上の略同じ時間範囲で検出される。なお、物体からの反射光が非干渉光に相当する。
【0019】
また、
図3及び
図5に示すように、物体の存在に加えて、当該測距装置1の発光タイミングで発光された照射光とは無関係に外部から到来するパルス状の干渉光が受光される場合、反射光波形以外にパルス状の波形(以下、干渉光波形)が検出される。なお、パルス状の干渉光には、他の測距装置からの照射光が含まれる。干渉光波形は、M個の受光情報の全てに発生するわけではなく単発的に表れる。なお、干渉光の発生源が他の車両等に搭載された他の測距装置1、又は本開示における測距装置1と同様の原理で発光及び受光を繰り返す他の測距装置である場合、干渉光波形がM個の受光情報毎に発生する可能性はある。しかし、測距装置1毎に発光タイミングがランダムに変化するため、干渉光波形は発光タイミングを起点とする時間軸上の反射光波形とは異なる時間範囲で検出されることになる。
図3では、3回中2回目だけで干渉光波形が検出された場合を示す。
【0020】
受光積算部6による受光情報の積算により、毎回略同じ位置で検出される反射光波形の振幅は増大し、単発的に検出される干渉光波形の振幅は抑制される。
図1に戻り、特性設定部7は、二値化部71と、フィルタ生成部72とを備える。
【0021】
二値化部71は、
図3に示すように、受光積算部6にて積算されるM個の受光情報のそれぞれについて、その受光情報によって示される受光波形を予め設定された二値化閾値THbを用いて二値化することで受光二値情報を生成する。この受光二値情報によって示される二値化波形は、受光情報が示す受光波形において信号強度が二値化閾値THbより大きい時間範囲では値(すなわち波形の振幅)が1.0となりそれ以外の時間範囲では値が0となる。二値化閾値THbは、例えば、干渉光の受光光量範囲の下限値に設定される。また、二値化閾値THbは、予め設定された固定値に限定されるものではなく、例えば、受光情報に応じて算出される可変値を用いてもよい。
【0022】
フィルタ生成部72は、二値積算部721と、判定部722とを備える。
二値積算部721は、二値化部71で生成されたM個の受光二値情報を、発光タイミングを一致させた時間軸上で積算する。積算した結果である積算二値情報が示す積算二値波形は、反射光波形が検出される時間範囲での値(すなわち波形の振幅)がMとなり、干渉光波形が検出される時間範囲での値がMより小さくなり、
図3では1となる。
【0023】
判定部722は、
図6に示すように、二値積算部721で生成された積算二値情報に基づき、積算二値情報が示す積算二値波形を、Mより小さい値に設定された判定閾値THjで二値化する。これにより、判定部722は、反射光波形が検出されると推定される有効範囲を抽出して、距離算出部8に供給する。なお、干渉光の受光時間範囲は、有効範囲以外の範囲である無効範囲に含まれる。つまり、無効範囲が指定範囲に相当する。判定閾値THjは、上述のように積算数Mに応じて設定される値の他、予め設定された固定閾値を用いてもよい。
【0024】
図1に戻り、距離算出部8は、測距部81と、フィルタリング部82とを備える。
測距部81は、
図7に示すように、積算受光情報に基づき、検出対象とすべき最低強度
以上に設定される抽出閾値THeより大きいピーク値を有するパルス状の波形のそれぞれについて受光タイミングを算出する。抽出閾値THeは、検出対象とすべき最低強度以上に設定される。抽出閾値THeは、例えば、二値化閾値THb以上、判定閾値THj以下の値に設定されるが、これに限定されない。
【0025】
更に、測距部81は、発光タイミングから受光タイミングまでの時間差から照射光を反射した物体までの距離を算出する。なお、受光タイミングは、実際にピークが得られるタイミングであってもよいし、信号レベルがある閾値以上となる範囲の真ん中となるタイミングであってもよい。また、発光タイミングは、離散的に得られる信号レベルから補間的な手法を用いて推定されるピークのタイミングであってもよい。また、測距部81にて算出される距離は、1個に限定されない。測距部81での処理の結果、反射光波形に基づく距離だけでなく、干渉光波形に基づく距離も算出される。以下、測距部81にて抽出閾値THeを用いて検出されたピークに関する情報を、エコー情報ECとよび、距離が近い順番にEC(1),EC(2),…と表記する。エコー情報EC(i)には、距離に加えて積算受光波形でのピーク値が含まれてもよい。
【0026】
フィルタリング部82は、判定部722にて抽出された時間軸上の有効範囲を、距離軸上の有効範囲(以下、有効距離範囲)に変換する。この変換は、判定部722にて行われてもよい。また、フィルタリング部82は、積算受光情報から抽出閾値THeを用いて、該抽出閾値THeより大きいピーク値を有するエコー情報ECを抽出する。フィルタリング部82は、抽出したエコー情報EC毎に、測距部81にて算出される算出距離のそれぞれについて、該算出距離が有効距離範囲に含まれるか否かを判定する。そして、フィルタリング部82は、算出距離が有効距離範囲に含まれないと判定した場合は、当該算出距離を破棄し、算出距離が有効範囲に内包されると判定した場合は、当該算出距離を、実在する物体までの距離として出力する。このフィルタリング部82での処理をフィルタ処理という。つまり、フィルタの特性が、判定部722にて抽出される有効範囲によって設定される。
【0027】
[1-2.効果]
以上詳述した第1参考形態によれば、以下の効果を奏する。
(1a)本参考形態では、M個の受光情報を積算した積算受光情報を用いて照射光を反射した物体までの距離を算出する。従って、受光情報においてランダムに発生するノイズを抑制でき、ノイズによる誤検出を抑制できる。
【0028】
(1b)本参考形態では、M個の受光情報のそれぞれを、二値化閾値THbを用いて二値化することで二値情報を生成する。更に、それら二値情報を積算した積算二値情報を、判定閾値THjを用いて二値化することで、反射光波形が存在すると推定される有効範囲を抽出する。そして、測距部81にてパルス状の波形毎に算出される距離のうち、有効範囲に内包される距離を、物体までの距離として出力する。つまり、有効範囲以外の無効範囲(すなわち、指定範囲)に内包される距離は破棄される。従って、本参考形態によれば、干渉光波形に基づく誤検出、すなわち物体が存在しないにも関わらず距離が検出されることを抑制できる。
【0029】
つまり、積算受光情報では、単発的にしか検出されない干渉光波形であっても、その1回の信号レベルが大きければ、反射光波形と同等以上のピーク値が得られる。このため、積算受光情報において、反射光波形と干渉光波形とを識別することが困難である場合がある。これに対して、積算二値情報は、受光情報が示す波形の信号レベルによらず、積算数に応じた振幅が得られるため、反射光波形と干渉光波形との識別が可能となる。
【0030】
(1c)本参考形態では、発光タイミングをランダムに変化させて測定したM個の受光
情報を用いて物体との距離を算出する。従って、他車両等に搭載された他の測距装置からの発光など、パルス状の波形を有する干渉光波形が、積算対象となるM個の受光情報において反射光波形と異なる時間で検出されることで、積算二値情報による有効範囲の検出精度を向上させることができる。
【0031】
[2.第2参考形態]
[2-1.第1参考形態との相違点]
第2参考形態は、基本的な構成は第1参考形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0032】
第2参考形態では、処理部5aにおける特性設定部7aの構成が、第1参考形態とは相違する。具体的には、特性設定部7aのうち、フィルタ生成部72aの構成が異なる。フィルタ生成部72aは、
図8に示すように、二値積算部721及び判定部722の代わりに論理演算部723を備える。
【0033】
論理演算部723は、
図9に示すように、二値化部71で生成されるM個の二値化情報の論理積を演算することで、有効範囲を抽出する。
これにより、M個の二値情報のすべてで信号が検出される範囲が有効範囲として抽出される。
【0034】
[2-2.効果]
以上詳述した第2参考形態によれば、前述した第1参考形態の効果(1a)を奏し、さらに、以下の効果(2a)~(2c)を奏する。
【0035】
(2a)本参考形態では、第1参考形態と同様の有効範囲が抽出されるため、干渉光波形に基づく誤検出、すなわち物体が存在しないにも関わらず距離が検出されることを抑制できる。
【0036】
(2b)本参考形態では、発光タイミングをランダムに変化させて計測したM個の受光情報を用いて物体との距離を算出する。従って、他の測距装置からの発光など、パルス状の波形を有する干渉光波形が、論理積演算の対象となるM個の受光情報において反射光波形とは異なる時間で検出されることで、論理演算部723による有効範囲の検出精度を向上させることができる。
【0037】
(2c)本参考形態では、第1参考形態と比較して簡易な処理によって、第1参考形態と同様の有効範囲を抽出できるため、処理部5aにおける処理負荷を軽減できる。
[3.第3参考形態]
[3-1.第1参考形態との相違点]
第3参考形態は、基本的な構成は第1参考形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0038】
第3参考形態では、処理部5bにおける距離算出部8bの構成が、第1参考形態とは相違する。具体的には、第1参考形態では、測距部81での測距処理の結果に対してフィルタリング部82によるフィルタ処理を実施する。これに対し、第2参考形態では、
図10に示すように、受光積算部6からの積算受光情報に対してフィルタリング部82bによるフィルタ処理を実施し、フィルタ処理の結果に対して、測距部81での測距処理を実施する。
【0039】
つまり、
図11に示すように、フィルタリング部82bでは、積算受光波形に対して時間軸上でフィルタ処理を施すことにより、有効期間に対応する時間範囲の信号波形が抽出され、有効期間以外の期間である無効期間に対応する時間範囲の信号波形が除去される。そして、測距部81は、フィルタ処理によって抽出されるパルス状の波形、すなわち反射光波形に対してだけ、測距処理を実行して、物体までの距離を含んだエコー情報ECを生成する。
【0040】
[3-2.効果]
以上詳述した第3参考形態によれば、前述した第1参考形態の効果(1a)~(1c)を奏し、さらに、以下の効果を奏する。
【0041】
(3a)本参考形態によれば、測距部81での処理の前に、干渉光波形が除去されるため、測距部81での処理負荷を軽減できる。
[3-3.変形例]
第3参考形態では、処理部5bとして、第1参考形態で説明した特性設定部7と距離算出部8bとを組み合わせた構成が示されているが、
図12に示す処理部5cのように、第2参考形態で説明した特性設定部7aと距離算出部8bとを組み合わせた構成でもよい。
【0042】
[4.第4参考形態]
[4-1.第1参考形態との相違点]
第4参考形態は、基本的な構成は第1参考形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0043】
第4参考形態では、処理部5dにおける特性設定部7d及び距離算出部8bの構成が、第1参考形態とは相違する。具体的には、特性設定部7dのうち、フィルタ生成部72dの構成が異なる。フィルタ生成部72dは、
図13に示すように、第1参考形態のフィルタ生成部72と比較して、判定部722が省略され、代わりに正規化部724を備える。更に、第4参考形態では、距離算出部8の代わりに、第3参考形態で説明した距離算出部8bを備える。
【0044】
正規化部724は、
図14に示すように、二値積算部721で得られた積算二値情報が表す積算値を、受光積算部6にて積算の対象となった受光情報の数である積算数Mで除算することで正規化情報を生成する。つまり、積算されるすべての受光情報で信号が検出される範囲では、正規化情報での信号レベルは1.0となり、一つの受光情報でのみ信号が検出される範囲では、正規化情報での信号レベルは1/Mとなる。
【0045】
フィルタリング部82bでは、
図15に示すように、正規化情報が示す信号レベルをゲインとして、積算受光情報に乗じる。これにより、単発的にパルス状の波形が検出される範囲では、波形のピーク値がより抑制され、抽出閾値THeより小さくなる可能性が高くなる。その結果、測距部81にて、ゲインが低い範囲に属するパルス状の波形に対して測距処理が実施される可能性が低下する。
【0046】
[4-2.効果]
以上詳述した第4参考形態によれば、前述した第1参考形態の効果(1a)を奏し、さらに、以下の効果(4a)~(4c)を奏する。
【0047】
(4a)本参考形態では、第1参考形態と同様の有効範囲に加えて、ゲインが1より小さい有効範囲が抽出される。このため、干渉光波形に基づく誤検出、すなわち物体が存在しないにも関わらず距離が検出されることを抑制できるだけでなく、毎回ではないが、高
い頻度で同じ範囲で検出されるパルス波形についても距離を算出できる。
【0048】
(4b)本参考形態では、発光タイミングをランダムに変化させて測定したM個の受光情報を用いて距離を算出する。従って、他の測距装置からの発光など、パルス状の波形を有する干渉光波形が、M個の受光情報において反射光波形と異なる時間で検出されることで、干渉光波形が検出される範囲における正規化情報のゲインを充分に抑制できる。
【0049】
(4c)本参考形態によれば、測距部81での処理の前のフィルタ処理によって、干渉光波形が除去される可能性が高くなるため、測距部81での処理負荷を軽減できる。
[4-3.変形例]
上記第1から第4参考形態では、フィルタリング部82は、測距部81で算出された物体までの距離に対して、フィルタ処理を行い、フィルタリング部82bは、受光積算部6で算出された時間軸上の積算受光波形に対して、フィルタ処理を行っている。
【0050】
測距部81が、受光タイミングを算出する際に、半値幅の算出に必要なデータや、ピーク付近の複数の離散的な信号レベル等の中間データを用いる場合、
図55~
図58に示すように、中間データに対してフィルタ処理を行ってもよい。
【0051】
例えば、
図55に示す距離算出部8qは、前置測距部81qと、フィルタリング部82と、後置測距部83qとを備える。
前置測距部81qは、中間データの算出に必要なタイミングを時間軸上で抽出して、抽出したタイミングを距離データに変換する。
図56では、半値幅の算出に必要となるピークの1/2レベルが得られるタイミングから算出される距離データである半値幅距離を抽出する場合を示す。
【0052】
フィルタリング部82は、距離軸上でフィルタ処理を行って、エコー情報ECの生成対象となるピークに関する半値幅距離を抽出する。
後置測距部83qは、フィルタリング部82で抽出された半値幅距離を用いて、照射光を反射した物体までの距離を算出する。
【0053】
また、
図57に示す距離算出部8rは、前置測距部81rと、フィルタリング部82bと、後置測距部83rとを備える。
前置測距部81rは、中間データの算出に必要なタイミングを時間軸上で抽出する。
図58では、半値幅の算出に必要となるピークの1/2レベルが得られるタイミングである半値幅時間を抽出する場合を示す。
【0054】
フィルタリング部82bは、前置測距部81rで抽出された半値幅時間に対して時間軸上でフィルタ処理を行って、エコー情報ECの生成対象となるピークに関する半値幅時間を抽出する。
【0055】
後置測距部83rは、フィルタリング部82bで抽出された半値幅時間を、距離データに変換して、変換された距離データを用いて、照射光を反射した物体までの距離を算出する。
【0056】
図56及び
図58では、中間データとして半値幅を用いる場合を例示したが、中間データは、これに限定されるものではなく、パルスのピーク時間など、抽出閾値THe以上のパルスから抽出される時間データ又は距離データであればよい。
【0057】
[5.第5参考形態]
[5-1.第1参考形態との相違点]
第5参考形態は、基本的な構成は第1参考形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0058】
第5参考形態では、処理部5eにおける特性設定部7e及び距離算出部8eの構成が、第1参考形態とは相違する。
図16に示すように、特性設定部7eは、ベースライン算出部73と、ピーク算出部74と、閾値設定部75とを備える。
【0059】
ベースライン算出部73は、受光積算部6にて積算の対象となる複数の受光情報毎に、ベースラインの値を表す個別ベースライン値を算出する。なお、ベースラインは、照射光に基づく反射光の影響、他のライダー装置等からの干渉光の影響、及びクラッタの影響を除いたオフセットとして受光される光量のことをいう。クラッタは、放射光が、当該測距装置1の筐体に反射して受光されることでゼロ距離付近に発生する受光ノイズである。ベースラインの値は、例えば、反射光、干渉光、及びクラッタの影響を受ける時間範囲を除去した時間範囲で検出される受光光量の平均値又は中央値を用いてもよい。ベースラインは、ノイズフロアレベルともいう。以下では、m番目の受光情報における個別ベースライン値をNmで表す。m=1,2,…,Mである。
【0060】
ベースライン算出部73は、積算受光情報におけるベースラインの値を表す積算ベースライン値を算出する。積算ベースライン値Nsは、積算受光情報に基づいて個別ベースライン値と同様に算出してもよいし、個別ベースライン値を合算すること(すなわち、Ns=N1+N2+…+NM)で算出してもよい。
【0061】
ピーク算出部74は、受光情報毎に、最大受光光量を取得する。ここでは、
図17に示すように、受光波形であるか干渉光波形であるかに関わらず選択される。なお、最大受光光量は、受光情報で示される全時間範囲内から取得してもよいし、例えば、クラッタが検出される時間範囲を除外した時間範囲内から取得してもよい。以下、m番目の受光情報における最大受光光量を生ピーク値A
mという。ピーク算出部74は、更に、M個の受光情報のそれぞれについて、生ピーク値A
mから個別ベースライン値N
mを減算することで、受光波形の相対ピーク値S
mを算出する。なお、相対ピーク値S
mの算出において、個別ベースライン値N
mの代わりに、積算ベースライン値Nsを積算数Mで除算した値を用いてもよい。
【0062】
閾値設定部75は、最大抽出部751を備える。
最大抽出部751は、ピーク算出部74にて算出されたM個の相対ピーク値S1~SMのうちの最大値である最大相対ピーク値Smax=MAX(S1,S2,…,SM)を抽出する。更に、最大抽出部751は、最大ピーク相対値Smaxにマージンαと、積算ベースライン値Nsを加えた値を、抽出閾値THeとして設定する。マージンαは省略されてもよい。
【0063】
距離算出部8eは、測距部81eを備える。測距部81eは、積算受光情報を用いて、閾値設定部75で設定された抽出閾値THeより大きなピーク値を有するパルス波形を抽出し、抽出したパルス波形のそれぞれの受信タイミングから、物体までの距離を算出する。つまり、測距部81eは、抽出閾値THeの設定を変更できる点が、測距部81とは異なる。そして、算出された距離とピーク値とを対応づけたエコー情報ECを生成して出力する。
【0064】
[5-2.効果]
以上詳述した第5参考形態によれば、前述した第1参考形態の効果(1a)を奏し、更
に、以下の効果(5a)を奏する。
【0065】
(5a)本参考形態では、M個の受光情報から抽出される最大相対ピーク値Smaxに基づいて、測距処理の対象となるパルス波形の抽出に用いる抽出閾値THeを設定する。従って、本参考形態によれば、干渉光波形に基づく誤検出、すなわち物体が存在しないにも関わらず距離が検出されることを抑制できると共に、干渉光波形に対して測距処理が行われることが抑制されるため、測距部81eでの処理負荷を軽減できる。また、第1~4実施例では時間範囲分のフィルタ用のメモリが必要なのに対して、最大相対ピーク値Smax分のメモリだけで済むため、実装に必要なメモリ量を削減する効果を有する。
【0066】
つまり、
図17に示すように、干渉光波形のピーク値が、反射光波形のピーク値より大きい場合でも、干渉光波形が複数の受光情報W(1)~W(M)にて同一タイミングで検出されない限り、積算受光情報における干渉光波形のピーク値は、抽出閾値THeを超えることがない。従って、抽出閾値THeによって干渉光波形を除去した上で測距処理を行うことができる。
【0067】
[5-3.変形例]
本参考形態では、受光積算部6は、複数の受光情報W(1)~W(M)を単純に加算することで積算受光情報を算出し、個別ベースライン値N1~NMの合計が積算ベースライン値Nsとなるようにしているが、本開示は、これに限定されるものではない。例えば、受光積算部6は、積算ベースライン値Nsがゼロとなるように、複数の受光情報W(1)~W(M)を積算するように構成されてもよい。以下では、Ns=0となるように積算された積算受光情報をゼロベース積算受光情報、Ns≠0となるように積算された積算受光情報を非ゼロベース積算受光情報という。
【0068】
具体的には、
図41に示すように、受光積算部6は、受光情報W(1)~W(M)毎に個別ベースライン値N
1~N
Mを算出する。更に、受光積算部6は、受光情報W(m)のそれぞれから、個別ベースライン値N
mを減算した結果(W(m)-N
m)を加算することでゼロベース積算受光情報を算出する。以下、この手法を、減算後積算方法という。
【0069】
図42に示すように、受光積算部6は、受光情報W(1)~W(M)を単純に加算した結果ΣW(m)から個別ベースライン値N
1~N
Mの合計値Nsumを減算することでゼロベース積算受光情報を算出する。減算に用いる値は、Nsumの代わりに、ΣW(m)から抽出されるベースライン値を用いてもよい。以下、この手法を、積算後減算方法という。
【0070】
図43に示すように、受光積算部6は、以下の手順で、ゼロベース積算受光情報を算出してもよい。すなわち、1番目の受光情報を1番目の中間積算情報とする。i=2~Mとして、i-1番目の受光情報から抽出される個別ベースライン値N
i-1を、i-1番目の中間積算情報から減算した結果に、i番目の受光情報を加算することでi番目の中間積算情報を順次算出する。そして、M番目の受光情報から抽出される個別ベースライン値N
Mを、M番目の中間積算情報から減算することで、ゼロベース積算受光情報を算出する。以下、この手法を、ゼロベース順次積算方法という。
【0071】
なお、上記説明では、i-1番目の中間積算情報から個別ベースライン値Ni-1を減算後に、i番目の受光情報を加算しているが、演算の順番はこれに限定されるものではない。例えば、i-1番目の中間積算情報とi番目の受光情報とを加算した結果から、個別ベースライン値Ni-1を減算する等してもよい。
【0072】
また、M番目の中間積算情報を積算受光情報とし、M番目の受光情報から抽出される個
別ベースライン値NMを積算ベースライン値Nsとする手法を、非ゼロベース順次積算方法という。
【0073】
受光積算部6が、Ns=0となる積算受光情報、即ちゼロベース積算受光情報を算出するように構成されている場合、抽出閾値THeは、以下の(1)~(3)式に示すいずれかの方法で設定されてもよい。
【0074】
THe=Smax (1)
THe=Amax-Nx (2)
THe=Amax-Nave (3)
但し、Amaxは、M個の生ピーク値A1~AMのうちの最大値MAX(A1,A2,…,AM)であり、最大生ピーク値という。Nxは、最大生ピーク値Amaxの抽出元となった受光情報における個別ベースライン値である。Naveは、M個の個別ベースライン値N1~NMの平均値AVE(N1,N2,…NM)である。なお、(1)~(3)式において、抽出閾値THeには、マージンαを加えてもよい。また、(2)のNx及び(3)式のNaveがオフセット値に相当する。
【0075】
受光積算部6が、非ゼロベース順次積算方法を用いて、Ns=NMとなる積算受光情報、即ち非ゼロベース積算受光情報を算出するように構成されている場合、抽出閾値THeは、以下の(4)~(7)式に示すいずれかの方法で設定されてもよい。
【0076】
THe=Smax+NM (4)
THe=Amax-Nx+NM (5)
THe=Amax-Nave+NM (6)
THe=Amax (7)
(4)~(6)式は、(1)~(3)式に、積算ベースライン値NsとなるM番目の受光情報の個別ベースライン値NMを加えた式である。(7)式は、(5)式においてNx=NMと仮定することで得られる近似式であり、閾値THeの算出を簡略化できる。なお、(4)~(7)式においても、抽出閾値THeにマージンαを加えてもよい。
【0077】
ここでは、M番目の受光情報の個別ベースライン値NMが非ゼロベース積算受光情報の積算ベースライン値Nsとなるように、受光情報を積算する場合について説明したが、受光情報の積算の仕方は、これに限定されるものではない。例えば、任意に選択される一つの受光情報の個別ベースライン値が、積算ベースライン値Nsとなるように構成されてもよい。また、任意に選択される任意個の受光情報の個別ベースライン値の合計値が、積算ベースライン値となるように構成されてもよい。
【0078】
なお、
図41~
図43を用いて説明した受光積算部6の処理は、第6参考形態以降だけでなく第1~第4参考形態における受光積算部6にも適用可能である。
[6.第6参考形態]
[6-1.第1参考形態との相違点]
第6参考形態は、基本的な構成は第1参考形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0079】
第6参考形態では、処理部5fにおける特性設定部7f及び距離算出部8eの構成が、第1参考形態とは相違する。但し、距離算出部8eは、第5参考形態で説明したものと同様である。
【0080】
図18に示すように、特性設定部7fは、受光積算部6から供給される積算受光情報に
基づいて抽出閾値THeを生成する。特性設定部7fは、ベースライン算出部73fと、ピーク算出部74fと、閾値設定部75fとを備える。
【0081】
ベースライン算出部73fは、受光積算部6より算出された積算受光情報のベースラインの値を表す積算ベースライン値Nsを算出する。なお、積算ベースライン値Nsは、積算受光情報から抽出される値を用いてもよいし、受光積算部6での積算対象となった複数の受光情報のそれぞれから抽出される個別ベースライン値N1~NMの合計値Nsumを用いてもよい。ピーク算出部74fは、積算受光情報から最大値を抽出し、抽出した最大値からベースライン算出部73fにて算出された積算ベースライン値Nsを減算することで、積算受光情報の相対ピーク値Sを算出する。
【0082】
閾値設定部75fは除算部752を備える。
除算部752は、ピーク算出部74fにて算出された積算受光情報の相対ピーク値Sを受光積算部6での積算対象となる受光情報の数である積算数Mで除算する。更に、除算部752は、その除算結果に、マージンαと、ベースライン算出部73fにて算出された積算ベースライン値Nsとを加算した値を、抽出閾値THeとして設定する。すなわち、(8)式に従って、抽出閾値THeを設定する。マージンαは、例えば、予め指定された定数及び除算値S/Mに応じて算出される値のうち、いずれか一方を用いてもよい。また、マージンαを省略し、(9)式に従って、抽出閾値THeを設定してもよい。
【0083】
THe=S/M+α+Ns (8)
THe=S/M+Ns (9)
個々の受光情報において、干渉光波形のピーク値が反射光波形のピークを超えることがないことが明らかな状況では、このように設定された抽出閾値THeを用いてもよい。
【0084】
[6-2.効果]
以上詳述した第6参考形態によれば、前述した第1参考形態の効果(1a)を奏し、更に、以下の効果(6a)を奏する。
【0085】
(6a)本参考形態では、特性設定部7fを受光積算部6の後段に設けられ、受光情報の積算毎に演算する必要が無く、積算受光情報に対する演算だけを実施すればよいため、演算量の削減効果を有する。
【0086】
[6-3.変形例]
受光積算部6が、Ns=0となる積算受光情報を算出するように構成されている場合、閾値設定部75fは、(10)又は(11)式に従って、抽出閾値THeを設定してもよい。
【0087】
THe=S/M+α (10)
THe=S/M (11)
[7.第7参考形態]
[7-1.第1参考形態との相違点]
第7参考形態は、基本的な構成は第1参考形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0088】
第7参考形態では、処理部5gにおける特性設定部7g及び距離算出部8eの構成が、第1参考形態とは相違する。但し、距離算出部8eは、第5参考形態で説明したものと同様である。
【0089】
図19に示すように、特性設定部7gは、ベースライン算出部73gと、ピーク算出部74と、閾値設定部75gとを備える。
ベースライン算出部73gは、ベースライン算出部73と同様に、M個の受光情報のそれぞれについて個別ベースライン値N
mを算出すると共に、積算ベースライン値Nsを算出する。ベースライン算出部73gは、更に、個別ベースライン値N
mのばらつきを算出する。ばらつきを表すパラメータとして、例えば、標準偏差を用いてもよい。
【0090】
閾値設定部75gは、最大抽出部751と、ばらつき算出部753と、閾値選択部754とを備える。
最大抽出部751は、第5参考形態で説明したものと同様であり、最大相対ピーク値Smaxを算出する。
【0091】
ばらつき算出部753は、ベースライン算出部73gにてM個の受光情報毎に算出される個別ベースライン値の標準偏差の平均値にMの平方根を乗算した値をばらつきσとし、σのG倍を許容ばらつき値として算出する。Gは正の実数である。Gは、ノイズが物体として誤検出される確率をどの程度とするかによって、適宜設定される。ここでは、ばらつきσを、M個の受光情報のそれぞれについて算出される個別ベースライン値N1~NMの標準偏差の平均値にMの平方根を乗算した値を用いているが、受光積算情報から算出される積算ベースライン値の標準偏差を用いてもよい。
【0092】
閾値選択部754は、
図20に示すように、最大ピーク相対値Smaxにマージンαを加えた値と、許容ばらつき値G×σと、あらかじめ設定された固定値Dとを比較する。固定値Dは、例えば、閉空間内など、ばらつきσが極端に小さい場合でも、適度な抽出閾値THeが得られるように設定される。そして、Smax+αが最大であれば、(12)式により抽出閾値THeを設定する。G×σが最大であれば、(13)式により抽出閾値THeを設定する。Dが最大であれば(14)式により抽出閾値THeを設定する。
【0093】
THe=Smax+α+Ns (12)
THe=G×σ+Ns (13)
THe=D+Ns (14)
なお、(12)式は、(4)~(7)式を用いて算出される抽出閾値THe、又は(5)~(7)式の右辺にマージンαを加えることで算出される抽出閾値THeに置き換えてもよい。
【0094】
[7-2.効果]
以上詳述した第7参考形態によれば、前述した第1参考形態の効果(1a)及び第5参考形態の効果(5a)を奏し、更に、以下の効果(7a)を奏する。
【0095】
(7a)本参考形態では、ベースライン値のばらつきσから算出される許容ばらつき値G×σと、最大ピーク値Smax+αと、固定値Dとの比較に基づいて抽出閾値THeの設定方法を切り替える。これにより、干渉光波形がノイズに埋もれるような場合でも、ノイズが反射光波形として誤検出されることを抑制できるだけでなく、ベースライン値のばらつきσが極端に小さい場合でも、適切な抽出閾値THeが設定される。
【0096】
[7-3.変形例]
受光積算部6が、積算ベースライン値Nsがゼロとなるように複数の受光情報を積算するように構成されている場合、閾値設定部75gは、(12)~(14)式の右辺から積算ベースライン値Nsを除いた式を用いて算出される抽出閾値THeを用いてもよい。
【0097】
[8.第8参考形態]
[8-1.第1参考形態との相違点]
第8参考形態は、基本的な構成は第1参考形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0098】
第8参考形態では、
図21に示すように、処理部5hにおける特性設定部7h及び距離算出部8hの構成が、第1参考形態とは相違する。
特性設定部7hは、第1設定部91と第2設定部92とを備える。
【0099】
第1設定部91は、第1~第4参考形態で説明した特性設定部7,7a,7dのいずれかと同様の構成を有し、反射光波形が存在しうる有効範囲を設定する。
第2設定部92は、第5~第7参考形態で説明した特性設定部7e~7gのいずれかと同様の構成を有し、抽出閾値THeを設定する。但し、第2設定部92として第6参考形態の特性設定部7fを採用した場合は、受光積算部6の出力が第2設定部92の入力となる。
【0100】
距離算出部8hは、二つの測距部81,81eと、フィルタリング部82と、切替部83とを備える。
測距部81及びフィルタリング部82は、第1参考形態で説明した距離算出部8と同様に動作する。なお、測距部81が第1測距部に相当し、測距部81及びフィルタリング部82は、第1処理部に相当する。
【0101】
測距部81eは、第5参考形態で説明した距離算出部8eと同様に動作する。測距部81eは、第2測距部及び第2処理部に相当する。
切替部83は、フィルタリング部82から出力される第1測距結果と、測距部81eから出力される第2測距結果とのうちいずれかを、予め設定された切替条件に従って出力する。
【0102】
切替条件として、例えば、別途設けられた切替スイッチの設定を用い、設定に従って、いずれかの測距結果を固定的に出力してもよい。また、切替条件として、距離閾値を用い、距離閾値より近い近距離範囲については、第2測距結果を出力し、距離閾値以上の遠距離範囲については第1測距結果を出力してもよい。この場合、測距部81には遠距離範囲に対応した時間範囲の積算受光情報が入力され、測距部81eには近距離範囲に対応した時間範囲の積算受光情報が入力されてもよい。
【0103】
[8-2.効果]
以上詳述した第8参考形態によれば、第1設定部91及び第2設定部92の構成に応じて、第1~第7参考形態の効果を奏し、更に、以下の効果(8a)を奏する。
【0104】
(8a)本参考形態では、干渉波の発生状況等に応じて距離算出部8hでの処理方法を切り替えることができるため、必要となるメモリ数を削減するとともに、干渉波の除去性能を向上させることができる。
【0105】
[9.第9参考形態]
[9-1.第1参考形態との相違点]
第8参考形態は、基本的な構成は第1参考形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0106】
第9参考形態では、
図22に示すように、処理部5iにおける特性設定部7h及び距離
算出部8iの構成が、第1参考形態とは相違する。但し、特性設定部7hは、第7参考形態にて説明したものと同様の構成を有する。
【0107】
距離算出部8iは、フィルタリング部82bと、二つの測距部81,81eと、切替部83とを備える。
フィルタリング部82b及び測距部81は、第3参考形態で説明した距離算出部8bと同様に動作する。これらフィルタリング部82b及び測距部81は、第1処理部に相当する。
【0108】
測距部81eは、第5参考形態で説明した距離算出部8eと同様に動作する。測距部81eは、第2処理部に相当する。
切替部83は、第8参考形態で説明したものと同様に動作する。
【0109】
[9-2.効果]
以上詳述した第9参考形態によれば、第8実施形態と同様の効果を得ることができる。
[10.第1実施形態]
[10-1.第1参考形態との相違点]
第1実施形態は、基本的な構成は第1参考形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0110】
第1実施形態では、処理部5jにおける特性設定部7j及び距離算出部8jの構成が、第1参考形態とは相違する。
図25に示すように、特性設定部7jは、ベースライン算出部73と、ピーク算出部74と、閾値設定部75jとを備える。
【0111】
ベースライン算出部73及びピーク算出部74は、第5参考形態での説明と同様である。つまり、ベースライン算出部73は、受光情報毎に個別ベースライン値Nmを算出すると共に、積算ベースライン値Nsを算出し、ピーク算出部74は、受光情報毎に最大受光光量Smを算出する。
【0112】
閾値設定部75jは、一次閾値設定部755と、二次閾値設定部756とを備える。
一次閾値設定部755は、第7参考形態で説明したばらつき算出部753と同様に、ベースライン値の許容ばらつきG×σを算出する。更に、一次閾値設定部755は、算出された許容ばらつきG×σに、積算ベースライン値Nsを加えた値を一次閾値TH1として出力する。なお、予め設定された固定値をDとして、一次閾値TH1は、G×σ+Ns及びD+Nsのうち、いずれか大きい方の値を用いてもよい。
【0113】
二次閾値設定部756は、第5参考形態で説明した最大抽出部751と同様に、最大相対ピーク値Smaxを算出する。更に、二次閾値設定部756は、算出された最大相対ピーク値Smaxに、マージンαと積算ベースライン値Nsとを加えた値を二次閾値TH2として出力する。
【0114】
つまり、一次閾値TH1は、(15)又は(16)式のいずれかを用いて設定され、二次閾値TH2は、(17)を用いて設定される。
TH1=G×σ+Ns (15)
TH1=D+Ns (16)
TH2=Smax+α+Ns (17)
なお、一次閾値TH1と二次閾値TH2との関係は、一般的には、
図26に示すように、TH1<TH2となるが、ベースラインのばらつきが大きく且つ反射光及び干渉光のピ
ーク値が小さい場合には、TH1≧TH2となる場合もある。
【0115】
距離算出部8jは、測距部81jと、フィルタリング部82jとを備える。
測距部81jは、積算受光情報から、一次閾値TH1より大きなピーク値を有するパルス波形を抽出し、抽出したパルス波形のそれぞれの受信タイミングから、物体までの距離Rを算出する。そして、測距部81jは、距離Rとピーク値Pとを対応付けたエコー情報ECを生成する。以下では、エコー情報ECのピーク値をエコーピーク値という。測距部81jは、生成したエコー情報ECを、エコーピーク値Pが大きい順にソートしてもよい。
【0116】
以下では、測距部81jにより生成されるエコー情報ECの数を検出エコー数Kとする。Kは0以上の整数である。生成されたエコー情報ECの中でエコーピーク値Pがk番目に大きいエコー情報をEC(k)、そのエコーピーク値をP(k)、距離をR(k)と表記する。
【0117】
次に、フィルタリング部82jでの処理の詳細を、
図27に示すフローチャートを用いて説明する。
本処理は、受光積算部6にて生成された積算受光情報から、測距部81jにて積算受光情報に対する測距処理が実行される毎に起動する。
【0118】
S110では、フィルタリング部82jは、検出エコー数Kが1以上であるか否かを判定し、K≧1であれば処理をS120に移行し、K<1であれば処理を終了する。
S120では、フィルタリング部82jは、測距部81jで検出されたエコー情報ECのうち、物体からの反射波に基づく有効エコー情報の数を表すカウント値Cnt、及びエコー情報ECの識別に用いるインデックスkを初期化する。具体的には、カウント値Cntは0に初期化され、インデックスkは1に初期化される。なお、有効エコー情報以外のエコー情報、すなわち、干渉波等に基づくエコー情報を無効エコー情報という。
【0119】
S130では、フィルタリング部82jは、エコー情報EC(k)のエコーピーク値P(k)が二次閾値TH2より大きいか否かを判定し、P(k)≦TH2であれば、処理をS140に移行し、P(k)>TH2であれば、処理をS150に移行する。
【0120】
S140では、フィルタリング部82jは、エコー情報EC(k)が有効エコー情報であるか無効エコー情報であるかを示すフラグFlg(k)に、無効エコー情報であることを示す値Falseを設定して、処理をS170に進める。
【0121】
S150では、フィルタリング部82jは、カウント値Cntを1増加させる。
続くS160では、フィルタリング部82jは、フラグFlg(k)に、有効エコー情報であることを示す値Trueを設定して、処理をS170に進める。
【0122】
S170では、フィルタリング部82jは、インデックスkを1増加させる。
S180では、フィルタリング部82jは、インデックスkが、検出エコー数K以下であるか否かを判定し、k≦Kであれば、処理をS130に戻し、k>Kであれば、処理を終了する。
【0123】
なお、本処理の結果として得られるカウント値Cntを、有効エコー数ともいう。また、エコー情報EC(k)にフラグFlg(k)=Trueを付与することが、エコー情報EC(k)を有効化することに相当し、エコー情報EC(k)にフラグFlg(k)=Falseを付与することが、エコー情報EC(k)を無効化することに相当する。無効化されたエコー情報EC(k)は、除去されてもよいし、有効化されたエコー情報EC(k
)と共に後段の処理に提供されてもよい。
【0124】
[10-2.効果]
以上詳述した第1実施形態によれば、前述した第1参考形態の効果(1a)を奏し、更に以下の効果(10a)(10b)を奏する。
【0125】
(10a)本実施形態では、二つの閾値TH1,TH2を用いて、2段階に分けて積算受光情報からエコー情報ECを生成し、更に、有効エコー情報を抽出する。つまり、TH1(すなわち、G×σ+Ns又はD+Ns)とTH2(すなわち、Smax+α+Ns)のうち、いずれか大きい方の閾値を用いて有効エコー情報を抽出する第5参考形態と同様な効果を得ることができる。
【0126】
(10b)本実施形態では、二つの閾値TH1,TH2を用いることにより、装置構成の自由度を向上させることができる。つまり、例えば、TH1だけを生成するIC、又は、TH2だけを生成するICが個別に既に存在する場合に、これらを用いて、柔軟に装置を構成できる。
【0127】
[10-3.変形例]
受光積算部6が、Ns=0となる積算受光情報を算出するように構成されている場合、二次閾値設定部756は、(17)式の代わりに、(1)~(3)式の右辺を用いて算出される値を二次閾値TH2としてもよい。また、受光積算部6が、非ゼロベースライン順次積算方法を用いて複数の受光情報を積算するように構成されている場合、二次閾値設定部756は、(17)式の代わりに。(4)~(7)式の右辺を用いて算出される値を二次閾値TH2としてもよい。
【0128】
[11.第2実施形態]
[11-1.第1実施形態との相違点]
第2実施形態は、基本的な構成は第1実施形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0129】
第2実施形態では、処理部5kにおける距離算出部8kの構成が、第1実施形態とは相違する。
図28に示すように、距離算出部8kは、測距部81jと、フィルタリング部82jと、検知判定部85とを備える。測距部81j及びフィルタリング部82jは、第1実施形態での説明と同様である。
【0130】
検知判定部85は、測距部81jで得られる検出エコー数Kと、フィルタリング部82jで得られる有効エコー数Cntに従って、適正に有効エコー情報が抽出されているか否かを判定する。
【0131】
検知判定部85での処理の詳細を、
図29に示すフローチャートを用いて説明する。
本処理は、フィルタリング部82jにて処理が実行される毎に起動する。
S210では、検知判定部85は、検出エコー数Kが0より大きく、かつ、有効エコー数Cntが0であるか否かを判定し、肯定判定した場合は、処理をS220に移行し、否定判定した場合は、処理をS230に移行する。
【0132】
S220では、検知判定部85は、検知ステータスE_STを、一次閾値TH1を用いて検出されたが、二次閾値TH2により無効とされたK個のエコーの中に、有効エコーが含まれない可能性があることを示す「未検知」に設定して処理を終了する。
【0133】
S230では、検知判定部85は、検知ステータスE_STを、有効エコーが適正に検知されたことを示す「検知」に設定して処理を終了する。
つまり、受光情報において、物体からの反射波に基づくエコー(以下、反射エコー)の方が、干渉波に基づくエコー(以下、干渉エコー)よりピーク値が大きい場合、反射エコーのピーク値に従って二次閾値TH2が設定される。この場合、反射エコーのピーク値は、受光積算部6での積算の結果、二次閾値TH2より大きくなるため、反射エコーのエコー情報は有効エコー情報として抽出される。また、干渉エコーのピーク値は、受光積算部6にて積算されても値に変化がなく、二次閾値TH2より小さいままであるため、干渉エコーのエコー情報は無効エコー情報として抽出される。
【0134】
これに対して、
図30に示すように、受光情報において、干渉エコーの方が反射エコーよりピーク値が大きい場合には、干渉エコーのピーク値に従って二次閾値TH2が設定される。この場合、二次閾値TH2は、積算後の反射エコーのピーク値より大きい場合があるため、反射エコーのエコー情報が無効エコー情報として抽出される可能性がある。検知ステータスE_STの「未検知」は、このような状況を表している。
【0135】
[11-2.効果]
以上詳述した第2実施形態によれば、前述した第1参考形態及び第1実施形態の効果(1a)(10a)(10b)を奏し、更に以下の効果(11a)を奏する。
【0136】
(11a)本実施形態では、干渉エコーの存在によって、反射エコーのエコー情報ECが無効エコー情報とされている可能性を、後段の処理に知らせることができる。
[11-3.変形例]
検知判定部85は、
図29に示す検知判定処理の代わりに、
図44に示す検知判定処理を実行してもよい。
【0137】
S240では、検知判定部85は、検出エコー数Kが0より大きく、かつ、有効エコー数Cntが0であるか否かを判定し、肯定判定した場合は、処理をS250に移行し、否定判定した場合は、処理をS270に移行する。
【0138】
S250では、検知判定部85は、検知ステータスE_STを、一次閾値TH1を用いて検出されたが、二次閾値TH2により無効とされたK個のエコーには、干渉波に基づくエコーが含まれ除去不能であることを示す「干渉あり」に設定する。
【0139】
続くS260では、検知判定部85は、K個のエコー情報EC(1)~EC(K)のフラグFlg(1)~Flg(K)を、いずれも、有効エコー情報であることを示すTrueに戻して処理を終了する。
【0140】
S270では、検知判定部85は、検知ステータスE_STを、干渉の影響がないことを示す「干渉なし」に設定して処理を終了する。
この場合、干渉エコーが検出される可能性があるが、反射エコーが非検出となることを抑制できる。
【0141】
[12.第3実施形態]
[12-1.第1実施形態との相違点]
第3実施形態は、基本的な構成は第1実施形態と同様であるため、相違点について以下に説明する。なお、第1実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0142】
第3実施形態では、処理部5lにおける距離算出部8lの構成が、第1実施形態とは相違する。
図31に示すように、距離算出部8lは、測距部81jと、フィルタリング部82jと、有効エコー抽出部86とを備える。測距部81j及びフィルタリング部82jは、第1実施形態での説明と同様である。
【0143】
有効エコー抽出部86は、反射エコーのエコー情報ECがフィルタリング部82jによって無効エコー情報であると判定されている可能性がある場合に、この無効化されたエコー情報を有効エコー情報として抽出する。
【0144】
有効エコー抽出部86での処理の詳細を、
図32に示すフローチャートを用いて説明する。
本処理は、フィルタリング部82jにて処理が実行される毎に起動する。
【0145】
S310では、有効エコー抽出部86は、検出エコー数Kが1より大きく、かつ、有効エコー数Cntが0であるか否かを判定する。有効エコー抽出部86は、肯定判定した場合は、有効エコー情報が適正に抽出されていない可能性があるとして、処理をS320に移行し、否定判定した場合は、有効エコー情報は適正に抽出されているとして、処理を終了する。
【0146】
S320では、有効エコー抽出部86は、エコー情報ECの識別に用いるインデックスkを2に設定する。なお、この時点でのカウント値(すなわち、有効エコー数)Cntは0であり、また、全てのエコー情報ECのフラグFlgが無効であることを示す値Falseに設定されている。
【0147】
続くS330では、有効エコー抽出部86は、カウント値Cntを1増加させる。
続くS340では、有効エコー抽出部86は、エコー情報EC(k)が有効エコー情報であるか否かを示すフラグFlg(k)を、有効であることを示す値Trueに設定する。
【0148】
続くS350では、有効エコー抽出部86は、インデックスkを1増加させる。
続くS360では、有効エコー抽出部86は、インデックスkが検出エコー数K以下であるか否かを判定し、k≦Kであれば処理をS330に戻し、k>Kであれば処理を終了する。
【0149】
なお、測距部81jで検出されるエコー情報ECはエコーピーク値Pが大きい順にソートされている。このため、本処理の結果、エコーピーク値が最大であることを無効条件として、無効条件を満たすエコー情報EC(1)を除く、他の全てのエコー情報EC(2)~EC(K)が有効エコー情報として抽出される。
【0150】
[12-2.効果]
以上詳述した第3実施形態によれば、前述した第1参考形態及び第1実施形態の効果(1a)(10a)(10b)を奏し、更に以下の効果(12a)を奏する。
【0151】
(12a)本実施形態では、フィルタリング部82jにて全てのエコー情報ECが無効エコー情報とされた場合であっても、エコー情報EC(1)を干渉エコー情報として排除することで、エコー情報EC(1)以外のエコー情報EC(2)~EC(K)を、有効エコー情報として抽出できる。
【0152】
[12-3.変形例]
有効エコー抽出部86での処理の変形例を、
図33のフローチャートを用いて説明する。変形例の処理では、
図32のフローチャートと比較して、S330の前にS325が挿入されている点、及びS360にて肯定判定された場合に、処理をS325に移行させる点で第3実施形態とは相違する。
【0153】
S325では、エコー情報EC(k)のエコーピーク値P(k)が、二次閾値TH2に定数Cを乗じた値より小さいか否かを判定し、P(k)<TH2×Cであれば処理をS330に移行し、P(k)≧TH2×Cであれば、処理をS350に移行する。
【0154】
定数Cは、例えば、積算ベースライン値Nsに対して±Bの範囲でベースライン値がばらつくものとして、TH2×C=TH2-Bとなるような値に設定される。つまりTH2×Cが無効閾値に相当する。但し、定数Cは、開発者が自由に設定できる固定閾値としてもよい。
【0155】
この変形例の処理によれば、干渉エコーのエコー情報EC(1)のエコーピーク値P(1)と同程度のピーク値を有する他のエコー情報も無効エコー情報として排除されるため、干渉エコーが複数存在する場合でも、有効エコー情報を適正に抽出できる。
【0156】
[13.第4実施形態]
[13-1.第1実施形態との相違点]
第4実施形態は、基本的な構成は第1実施形態と同様であるため、相違点について以下に説明する。なお、第1実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0157】
第4実施形態では、処理部5mにおける距離算出部8mの構成が、第1実施形態とは相違する。
図34に示すように、距離算出部8mは、測距部81jと、フィルタリング部82jと、有効エコー抽出部86と、検知判定部85とを備える。測距部81j及びフィルタリング部82jは、第1実施形態での説明と同様であり、検知判定部85は、第2実施形態での説明と同様であり、有効エコー抽出部86は、第3実施形態での説明と同様である。但し、検知判定部85では、有効エコー抽出部86での処理結果として得られる有効エコー数Cntを用いて判定を実行する。
【0158】
[13-2.効果]
以上詳述した第4実施形態によれば、前述した第1参考形態及び第1~第3実施形態の効果(1a)(10a)(10b)(11a)(12a)を奏する。
【0159】
[14.第5実施形態]
[14-1.第4実施形態との相違点]
第5実施形態は、基本的な構成は第4実施形態と同様であるため、相違点について以下に説明する。なお、第4実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0160】
第5実施形態では、処理部5nにおける特性設定部7n及び距離算出部8nの構成が、第4実施形態とは相違する。
図35に示すように、特性設定部7nは、ベースライン算出部73と、ピーク算出部74と、閾値設定部75jと、ピークばらつき算出部76とを備える。ピークばらつき算出部76以外は、第1実施形態での説明と同様である。
【0161】
ピークばらつき算出部76は、積算の対象となるM個の受光情報のうち、m回目の計測
で得られた受光情報において、最大受光光量が検出されたタイミングである最大受光タイミングtmを用いてばらつき度合いを算出する。
【0162】
ピークばらつき算出部76が実行する処理の詳細を、
図36のフローチャートを用いて説明する。
S410では、ピークばらつき算出部76は、ばらつきの度合いを表すばらつきカウント値V_Cnt及び積算の対象となるM個の受光情報の識別に用いるインデックスmを初期化する。具体的には、V_Cntは0に設定され、mは2に設定される。
【0163】
続くS420では、ピークばらつき算出部76は、m回目及びm-1回目の計測で得られた各受光情報における最大受光タイミングtm,tm-1の差の絶対値(以下、タイミング差)|tm-tm-1|が、予め設定された閾値βより大きいか否かを判定する。ピークばらつき算出部76は、|tm-tm-1|>βであれば、処理をS430に移行し、|tm-tm-1|≦βであれば、処理をS440に移行する。βは、計測周期等に基づき、同一物体からの反射エコーのピークが検出されるタイミングの時間的なばらつきを考慮して、例えば、同一物体であるとみなせる許容ばらつきの最大値に設定する。
【0164】
S430では、ピークばらつき算出部76は、ばらつきカウント値V_Cntを1増加させて、処理をS440に進める。
S440では、ピークばらつき算出部76は、インデックスmを1増加させる。
【0165】
続くS450では、ピークばらつき算出部76は、インデックスmが積算数M以下であるか否かを判定し、m≦Mであれば処理をS420に戻し、m>Mであれば処理を終了する。
つまり、
図37に示すように、同一物体からの反射光に基づく生ピーク値は、積算の対象となるM個の受光情報において、いずれも略同じタイミングで検出される。これに対して、干渉光に基づく生ピーク値は、これらとは異なるタイミングで単発的に検出される。そして、同一物体に基づく生ピーク値より、干渉光に基づく生ピーク値の方が大きい場合、最大受光タイミングは、干渉光が検出される受光情報だけ、他の受光情報とは異なる。その結果、例えば、
図36では、干渉光が検出される受光情報の最大受光タイミングt2を使用して算出される二つのタイミング差|t2-t1|及び|t3-t2|が閾値βより大きくなり、ばらつきカウント値V_Cntがカウントアップされる。
【0166】
距離算出部8nは、第3実施形態で説明した距離算出部8mと比較して、検知判定部85nの構成が異なる。但し、有効エコー抽出部86は、
図32のフローチャートに示した処理、即ち、エコー情報EC(1)を、無効エコー情報として除去し、それ以外のエコー情報を有効エコー情報とする処理を実行する。
【0167】
検知判定部85nでの処理の詳細を、
図38のフローチャートを用いて説明する。
図38のフローチャートは、
図29のフローチャートと比較して、S210とS220との間にS215が追加されている点で相違する。
【0168】
S215では、検知判定部85nは、バラツキカウント値V_Cntが予め設定されたバラツキ閾値THv以下であるか否かを判定し、V_Cnt>THvであれば、S220に処理を移行し、V_Cnt≦THvであれば、処理をS230に移行する。
【0169】
ばらつき閾値THvは、例えば2に設定される。THv=2の場合、S215での処理は、各受光情報で検出される最大受光光量を有するピークの中で、干渉波に基づくピーク(すなわち、干渉エコー)の数が1以下であるか否かを判定することに相当する。
【0170】
つまり、最大受光光量を有するピークとして検出される干渉エコーが一つ以下である場合は、有効エコー抽出部86で、干渉エコーのエコー情報は無効エコー情報とされ、それ以外のエコー情報が有効エコー情報として抽出される。これにより、検知ステータスE_STの値は「検知」に設定される。一方、干渉エコーが二つ以上である場合は、有効エコー抽出部86で、有効エコー情報が正しく抽出されない可能性があるため、検知ステータスE_STの値は「未検知」に設定される。
【0171】
[14-2.効果]
以上詳述した第5実施形態によれば、前述した第4実施形態と同様に、第1参考形態及び第1~第3実施形態の効果(1a)(10a)(10b)(11a)(12a)を奏し、更に以下の効果(14a)を奏する。
【0172】
(14a)本実施形態では、受光情報において反射エコーより大きい生ピーク値を有する干渉エコーが含まれている程度を、最大受光タイミングのばらつきから判定し、程度が大きい場合には、検知ステータスE_STを「未検知」とする。このため、干渉エコーの影響を受けた誤ったエコー情報が、後段に提供されることを抑制できる。
【0173】
[14-3.変形例]
上記第5実施形態では、ばらつきカウント値V_Cntを、検知判定部85nでの処理に利用しているが、
図35中の点線矢印で示すように、有効エコー抽出部86での処理に利用してもよい。この場合、
図32のフローチャートにおいて、S310の直前又は直後にステップを挿入し、V_Cnt>2の場合は、フラグFlgの書き換えを実行することなく処理を終了してもよい。
【0174】
[15.第6実施形態]
[15-1.第1実施形態との相違点]
第6実施形態は、基本的な構成は第1実施形態と同様であるため、相違点について以下に説明する。なお、第1実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。
【0175】
第6実施形態では、処理部5oにおける特性設定部7o及び距離算出部8oの構成が、第1実施形態とは相違する。
図39に示すように、特性設定部7oは、ベースライン算出部73と、ピーク算出部74と、閾値設定部75oとを備える。ベースライン算出部73及びピーク算出部74は、第1実施形態での説明と同様である。
【0176】
閾値設定部75oは、一次閾値設定部755と、二次閾値設定部756oとを備える。一次閾値設定部755は、第1実施形態での説明と同様である。
二次閾値設定部756oは、ピーク算出部74にて受光情報W(1)~W(M)のそれぞれについて算出される最大受光光量(即ち、生ピーク値)A1~AMを、値が大きい順にソートする。そして、m番目に大きい最大受光光量Amを、TH2(m)と表記するものとして、M個の二次閾値TH2(1)~TH2(M)を生成して、距離算出部8oに供給する。
【0177】
距離算出部8oは、測距部81jと、フィルタリング部82oと、検知判定部85とを備える。測距部81jは、第1実施形態での説明と同様である。検知判定部85は、第2実施形態での説明と同様である。
【0178】
フィルタリング部82oでの処理の詳細を、
図40に示すフローチャートを用いて説明する。
本処理は、受光積算部6にて生成された積算受光情報について、測距部81jによる測距処理の結果が出力される毎に起動する。なお、測距部81jから供給されるK個のエコー情報EC(1)~EC(K)は、対応するパルス状の波形における受光量の最大値であるエコーピーク値P(k)が大きい順にソートされていること、また、K≦Mであることを前提とする。
【0179】
本処理は、
図27のフローチャートと比較して、S130の代わりにS135を実行する点で相違する。
S135では、フィルタリング部82oは、ピーク値がk番目に大きいエコー情報EC(k)のエコーピーク値P(k)が、値がk番目に大きい二次閾値TH2(k)より大きいか否かを判定する。フィルタリング部82oは、P(k)≦TH2(k)であれば、処理をS140に移行し、P(k)>TH2(k)であれば、処理をS150に移行する。
【0180】
ここで、一つの干渉エコーは、複数の受光情報のいずれかでのみ検出されるとすると、前述の処理によって、積算後の反射エコーより大きいエコーピーク値Pを有する1又は複数の干渉エコーのエコー情報をいずれも無効エコー情報として除去することができる。
【0181】
[15-2.効果]
以上詳述した第6実施形態によれば、前述した第1参考形態及び第1実施形態の効果(1a)(10a)(10b)を奏し、更に以下の効果(15a)を奏する。
【0182】
(15a)本実施形態によれば、積算後の反射エコーのエコーピーク値Pより大きいピーク値を有する1又は複数の干渉エコーのエコー情報を、すべて除去できるため、最終的に抽出される有効エコー情報に基づく物体検出の信頼性を向上させることができる。
【0183】
なお、本実施形態では、エコー情報ECを、エコーピーク値Pが大きい順にソートしたが、エコーピーク値Pの小さい順にソートし、同様に小さい順にソートされた二次閾値TH2と比較してもよい。
【0184】
[16.第7実施形態]
[16-1.想定する状況]
第7実施形態の構成を説明する前に、本実施形態において、想定する干渉光の態様について説明する。
【0185】
本実施形態では、干渉光がフラッシュ型ライダーからの照射光である場合を想定する。フラッシュ型ライダーは、光を短い周期で繰り返し送信する。また、フラッシュ型ライダーは、投光時に拡散させて光を放射するため、他のタイプのライダーより、単位面積当たりの光の強度が弱くなる。このため、個々の受光情報において複数の干渉光が検出されるだけでなく、受光情報毎に、その複数の干渉光が検出されるタイミングもばらつく。その結果、
図45に示すように、積算受光情報においる干渉光の波形は、各受光情報にて検出される干渉エコーのピーク値を単純に合計した値より低いピーク値を有し、且つ、干渉光が存在する時間範囲の全体を覆うような広いパルス幅を有する。このように積算された干渉エコーは、第2閾値TH2より大きな値となって、信号光として検出されてしまう場合がある。なお、
図45では、図面を見易くするために、ノイズフロアを省略して示す。
【0186】
本実施形態では、このような状況において、干渉エコーを除去できないとしても、干渉エコーの影響で、反射エコーが未検出となる事態が発生することを抑制する。
[16-2.第1実施形態との相違点]
第7実施形態は、基本的な構成は第1実施形態と同様であるため、相違点について以下に説明する。なお、第1参考形態と同じ符号は、同一の構成を示すものであって、先行す
る説明を参照する。
【0187】
第7実施形態では、処理部5pにおける特性設定部7p及び距離算出部8pの構成が、第1実施形態とは相違する。
図46に示すように、特性設定部7pは、ベースライン算出部73と、ピーク算出部74と、閾値設定部75jと、比較値設定部77とを備える。つまり、特性設定部7pは、第1実施形態における特性設定部7jに、比較値設定部77を追加した構成を有する。
【0188】
比較値設定部77は、干渉の有無の判定に用いる比較値Dを算出して、距離算出部8pに供給する。比較値Dは、(18)式に示すように、ピーク算出部74にて複数の受光情報のそれぞれについて算出される相対ピーク値S1~SMの合計値Ssumに、ベースライン算出部73で算出される積算ベースライン値Nsを加算することで算出される。
【0189】
D=Ssum+Ns (18)
距離算出部8pは、測距部81jと、フィルタリング部82pとを備える。
フィルタリング部82pは、(19)式を満たす場合に、第1実施形態にて説明したフィルタリング部82jの処理を実行する。
【0190】
|D-P(1)|<THp (19)
P(1)は、エコー情報EC(1)のピーク値であり、測距部81jで抽出されるK個のエコーの中で最大のピーク値である。THpは、干渉閾値である。干渉閾値THpは、例えば、同一物標に基づいて各受光情報で検出される相対ピーク値の合計と、その物標について積算受光情報で検出される相対ピーク値との差分について、その差分の大きさやばらつきを実験的に算出した結果に基づいて設定される。また、干渉閾値THpは、最大相対ピーク値Smaxに、係数を乗じることで設定されてもよい。
【0191】
つまり、
図47及び
図48に示すように、M個の受光情報から抽出される相対ピーク値S
1~S
Mに、干渉エコーに基づく相対ピーク値が含まれていない場合、比較値Dとピーク値P(1)は、ほぼ同じ値となる。このため、(19)式を充足していれば、エコー情報EC(1)は、反射エコーであると判定できる。なお、
図47は、干渉光が存在しない場合、
図48は、干渉光が信号光より小さい場合である。
【0192】
図49及び
図50に示すように、M個の受光情報から抽出される相対ピーク値S
1~S
Mに、干渉エコーに基づく相対ピーク値が含まれている場合は、比較値Dとピーク値P(1)とは異なった値になる可能性が高い。このため、(19)式を非充足であれば、測距部81jで抽出されたエコー情報EC(1)~EC(K)の中に干渉エコーが含まれると判定できる。なお、
図49は、干渉エコーに基づく相対ピーク値が全ての受光情報において検出される場合であり、
図50は、干渉エコーに基づく相対ピーク値が一つの受光情報でのみ検出される場合である。
【0193】
[16-3.効果]
以上詳述した第6実施形態によれば、前述した第1参考形態及び第1実施形態の効果(1a)(10a)(10b)を奏し、更に以下の効果(16a)を奏する。
【0194】
(16a)本実施形態では、フラッシュ型ライダーからの照射光を干渉光として受光した場合に、干渉光の影響で、反射光が非検出となることを抑制できる。
[16-4.変形例]
本実施形態において、受光積算部6が、非ゼロベースライン順次積算方法を用いて、複数の受光情報を積算すし、二次閾値設定部756が(7)式に従って、最大生ピーク値Amaxを二次閾値TH2として設定するように構成されている場合、以下の問題点がある
。すなわち、
図51に示すように外乱光のばらつきにより、個別ベースライン値N
mが信号光及び干渉光の生ピーク値A
mより大きくなる場合がある。
図51では、1番目の受光情報W(1)が該当する場合について示す。この場合、A
1=N
1として検出される。この結果、積算受光情報は、2~M番目の受光情報を積算した結果と等しくなる。このとき、Amax=A
1であるため、二次閾値TH2=A
1に設定される。その結果、積算受光情報で検出される全てのピークが、二次閾値TH2より小さくなり、干渉エコーだけでなく、反射エコーも非検出となる場合がある。
【0195】
そこで、フィルタリング部82pは、一次閾値TH1を用いて検出されるエコー情報EC(1)の振幅P(1)=S2+A3を用いて、(20)式を満たすか否かを判定する。
P(1)<MAX(N1,N2,…NM) (20)
(20)式を充足する場合は、二次閾値TH2の使用するフィルタリング部82pの処理を禁止する。これにより、いずれかの受光情報において、反射光が外乱光に埋もれる状況であった場合に、フィルタリング部82pの処理が禁止され、一次閾値TH1を用いて抽出される全てのエコー情報EC(1)~EC(K)が、後段の処理に提供される。これにより、干渉エコーが反射エコーとして誤検出される可能性があるが、反射エコーが未検出となることを抑制できる。
【0196】
[17.他の実施形態]
以上、本開示の実施形態及び参考形態について説明したが、本開示は前述の実施形態及び参考形態に限定されることなく、種々変形して実施することができる。
【0197】
(17a)第1参考形態において、判定部722では、判定閾値より大きい範囲を有効範囲として抽出しているが、本開示は、これに限定されるものではない。例えば、干渉光波形が存在すると推定される干渉範囲を抽出するための別の判定閾値を設定し、これら判定閾値を用いて抽出される干渉範囲を無効範囲とし、それ以外を有効範囲として抽出する等してもよい。
【0198】
(17b)上記実施形態及び参考形態では、特性設定部7,7a,7d~7hでの処理結果を用いて、距離算出部8,8b,8e,8h,8iは、干渉光によるパルス状の波形に基づく算出結果を除外するように構成されているが、本開示は、これに限定されるものではない。例えば、無効範囲(すなわち、指定範囲)に存在するパルス状の波形に基づいて算出された距離を除外する代わりに、この算出された距離に、干渉光に基づくことを示すフラグを付与してもよい。この場合、距離の算出結果を利用する後段の処理又はユーザが、フラグに従って干渉光の影響を除去する処置を行うようにしてもよい。
【0199】
(17c)本開示に記載の受光部3は、受光素子としてSPADを用いる場合について説明したが、本開示はこれに限定されるものではなく、受光強度の時間変化を検出できれば、どのような受光素子を用いてもよい。
【0200】
(17d)本開示に記載の二値化部71は、二値化の対象となる被二値化情報として、積算の対象となる複数の受光情報を用いているが、本開示はこれに限定されるものではない。例えば、受光情報の積算数が3である場合、二値化部71は、
図23及び
図24に示すように、1回目の受光情報と、1回目及び2回目の受光情報を積算した情報と、1回目~3回目の受光情報を積算した情報とを、被二値化情報としてもよい。つまり、受光情報を積算する過程で逐次生成される情報によって示される受光波形を予め設定された二値化閾値THbを用いて二値化することで受光二値情報を生成してもよい。
【0201】
このような二値化部71を適用した場合、第1参考形態で示した二値積算部721によって生成される積算二値情報が示す積算二値波形は、
図23に示すように、干渉光波形が
検出される時間範囲での値が、
図3に示した第1参考形態の場合とは異なり、2となる。また、第2参考形態で示した論理演算部723によって生成される論理積情報が示す波形は、
図24に示すように、第2参考形態の場合と同様である。
【0202】
(17e)上記実施形態及び参考形態では、一つの発光部2において、発光トリガ信号の出力周期T1,T2,T3,…一定の範囲内でランダムに変化させているが、本開示は、これに限定されるものではない。例えば、
図52に示すように、異なる照射方向に光を照射する複数の発光部2を備えてもよい。複数の発光部2を備える場合、
図53に示すように、複数の発光部2のそれぞれにおいて、出力周期をランダムに変化させてもよい。また、
図54に示すように、各発光部2は、それぞれの出力周期を一定値とし、発光部2毎に、出力周期の一定値を異ならせてもよい。また、例えばスキャナーミラーを搭載するライダーのようにスキャナが動くことで1つの発光部2が異なる照射方向に光を照射するように構成されている場合に、照射方向毎に出力周期を変化させてもよい。
【0203】
(17f)本開示に記載の処理部5,5a~5p及びその手法は、コンピュータプログラムにより具体化された一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリを構成することによって提供された専用コンピュータにより、実現されてもよい。あるいは、本開示に記載の処理部5,5a~5p及びその手法は、一つ以上の専用ハードウェア論理回路によってプロセッサを構成することによって提供された専用コンピュータにより、実現されてもよい。もしくは、本開示に記載の処理部5,5a~5p及びその手法は、一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリと一つ以上のハードウェア論理回路によって構成されたプロセッサとの組み合わせにより構成された一つ以上の専用コンピュータにより、実現されてもよい。また、コンピュータプログラムは、コンピュータにより実行されるインストラクションとして、コンピュータ読み取り可能な非遷移有形記録媒体に記憶されてもよい。処理部5,5a~5pに含まれる各部の機能を実現する手法には、必ずしもソフトウェアが含まれている必要はなく、その全部の機能が、一つあるいは複数のハードウェアを用いて実現されてもよい。
【0204】
(17g)上記実施形態及び参考形態における1つの構成要素が有する複数の機能を、複数の構成要素によって実現したり、1つの構成要素が有する1つの機能を、複数の構成要素によって実現したりしてもよい。また、複数の構成要素が有する複数の機能を、1つの構成要素によって実現したり、複数の構成要素によって実現される1つの機能を、1つの構成要素によって実現したりしてもよい。また、上記実施形態及び参考形態の構成の一部を省略してもよい。また、上記実施形態及び参考形態の構成の少なくとも一部を、他の上記実施形態及び参考形態の構成に対して付加又は置換してもよい。
【0205】
(17h)第1~第7実施形態には、第5参考形態、及びその変形例に記載した積算受光情報の算出方法、及び抽出閾値の設定方法を適用してもよい。但し、この場合、「抽出閾値」は、「二次閾値」に読み替えるものとする。
【0206】
(17i)前述した測距装置1の他、当該測距装置1を構成要素とするシステム、当該測距装置1の処理部5,5a~5p又はその一部としてコンピュータを機能させるためのプログラム、このプログラムを記録した半導体メモリ等の非遷移的実体的記録媒体、測距方法など、種々の形態で本開示を実現することもできる。
【符号の説明】
【0207】
1…測距装置、2…発光部、3…受光部、4…タイミング制御部、5j…処理部、6…受光積算部、7j…特性設定部、8j…距離算出部、73…ベースライン算出部、74…ピーク算出部、閾値設定部75j、81j…測距部、82j…フィルタリング部、755…一次閾値設定部、756…二次閾値設定部。