JP2020052051A - 光制御装置、制御方法、プログラム及び記憶媒体 - Google Patents

Abstract

【課題】ライダを利用して、周囲環境にあるランドマークを捕捉するとき、走査角度分解能に対してランドマークが相対的に小さい場合には計測点が過度に少なくなり、形状等が正しく認識できないことがある。【解決手段】ランドマーク位置予測部は、車両の現在位置の予測値と地図上でのランドマークの位置とに基づき、ランドマークの存在が予測される予測角度範囲を設定する。同期制御部は、予測角度範囲については、他の範囲よりも光パルスの走査密度が高くなるように可変パルストリガ信号及びセグメント抽出信号を生成する。【選択図】図８

Description

本発明は、測定用の光パルスの出射制御技術に関する。

従来から、周辺に存在する物体との距離を測定する技術が知られている。例えば、特許文献１には、レーザ光を間欠的に発光させつつ水平方向を走査し、その反射光を受信することで、物体表面の点群を検出するライダを搭載した車載システムが開示されている。

特開２０１４−８９６９１号公報

ライダを利用して、周囲環境にあるランドマークを捕捉するとき、当該ランドマークが遠方にある場合など、走査角度分解能に対して走査面内に含まれるランドマークが相対的に小さい場合には、当該ランドマークに対応する計測点が過度に少なくなり、ランドマークの形状等が正しく認識できないことがある。

本発明は、上記のような課題を解決するためになされたものであり、測定範囲内に存在するランドマークを高精度に測定することが可能な光制御装置を提供することを主な目的とする。

請求項１に記載の発明は、光制御装置であって、出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部と、少なくとも所定の対象物の位置を示す第１情報を取得する第１取得部と、前記所定の対象物の光の反射率に関連する情報であって、地図情報に記憶された第２情報を、前記地図情報から取得する第２取得部と、前記出射部を制御する制御部と、を備え、前記制御部は、前記移動体の現在位置情報と前記第１情報とに基づいて推定された前記所定の対象物が存在する第１方向については、前記第２情報が示す前記所定の対象物の光の反射率に応じた強度で前記光を出射するように、前記出射部を制御することを特徴とする。

請求項５に記載の発明は、出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部を制御する光制御装置が実行する制御方法であって、少なくとも所定の対象物の位置を示す第１情報を取得する第１取得工程と、前記所定の対象物の光の反射率に関連する情報であって、地図情報に記憶された第２情報を、前記地図情報から取得する第２取得工程と、前記出射部を制御する制御工程と、を有し、前記制御工程は、前記移動体の現在位置情報と前記第１情報とに基づいて推定された前記所定の対象物が存在する第１方向については、前記第２情報が示す前記所定の対象物の光の反射率に応じた強度で前記光を出射するように、前記出射部を制御することを特徴とする。

請求項６に記載の発明は、出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部を制御するコンピュータが実行するプログラムであって、少なくとも所定の対象物の位置を示す第１情報を取得する第１取得部と、前記所定の対象物の光の反射率に関連する情報であって、地図情報に記憶された第２情報を、前記地図情報から取得する第２取得部と、前記出射部を制御する制御部として前記コンピュータを機能させ、前記制御部は、前記移動体の現在位置情報と前記第１情報とに基づいて推定された前記所定の対象物が存在する第１方向については、前記第２情報が示す前記所定の対象物の光の反射率に応じた強度で前記光を出射するように、前記出射部を制御することを特徴とする。

ライダユニットの概略構成である。 光送受信部のブロック構成を示す。 可変パルストリガ信号及びセグメント抽出信号の波形を示す。 予測角度範囲に属しないスキャン角度に対応するセグメントの可変パルストリガ信号の波形を示す。 予測角度範囲に属するスキャン角度に対応するセグメントの可変パルストリガ信号の波形を示す。 パルスレートを予測角度範囲外と同一である約１３．７ｋＨｚに固定して光パルスを出射した場合の光パルスの光路を示す。 パルスレートを約６８．５ｋＨｚに上げて光パルスを出射した場合の光パルスの光路を示す。 本実施例の処理手順を示すフローチャートである。

本発明の好適な実施形態によれば、光制御装置は、出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部と、少なくとも所定の対象物の位置を示す第１情報を取得する第１取得部と、前記出射部を制御する制御部と、を備え、前記制御部は、前記移動体の現在位置情報と前記第１情報とに基づいて推定された前記所定の対象物が存在する第１方向については、他の方向とは異なる制御を行う。

上記光制御装置は、出射部と受光部とを有する送受光部と、第１取得部と、制御部とを備える。第１取得部は、少なくとも所定の対象物の位置を示す第１情報を取得する。制御部は、出射部を制御し、移動体の現在位置情報と第１情報とに基づいて推定された所定の対象物が存在する第１方向については、他の方向とは異なる制御を行う。この態様により、光制御装置は、所定の対象物が存在すると推定された方向について、他の方向とは異なる光の出射制御を行うことができる。

上記光制御装置の一態様では、前記制御部は、前記第１方向については、前記他の方向よりも前記光の出射頻度を上げるように前記出射部を制御する。このようにすることで、光制御装置は、所定の対象物に対し、効率的かつ高密度に光を照射することができる。

上記光制御装置の他の一態様では、前記制御部は、前記第１方向については、前記他の方向よりも、前記光の強度を低くする制御を行う。この態様により、光制御装置は、出射頻度を上げた場合であっても、出射光の平均パワーの増加を好適に抑制してアイセーフを実現することができる。

上記光制御装置の他の一態様では、光制御装置は、前記所定の対象物の光の反射率に関連する第２情報を取得する第２取得部を更に備え、前記制御部は、前記光の反射率が所定率以上の場合に、前記他の方向よりも、前記光の強度を低くする制御を行う。この態様により、光制御装置は、光の出射強度を弱めても支障がない場合に限り光の出射強度を弱め、所定の対象物で反射された光を確実に受信することができる。

上記光制御装置の他の一態様では、前記制御部は、前記第１方向については、前記他の方向よりも走査速度を遅くするように前記出射部を制御する。この態様によっても、光制御装置は、所定の対象物に対して高密度に光を照射することができる。

本発明の他の好適な実施形態によれば、光制御装置は、光を出射する出射部と前記光を受光する受光部とを有する送受光部と、少なくとも所定の対象物の位置を示す第１情報を取得する第１取得部と、前記第１情報と、移動体の現在位置情報と、に基づいて、前記出射部の出射範囲を決定する決定部と、を備える。この態様によれば、光制御装置は、光の出射範囲を、所定の対象物の存在が予測される範囲に的確に定めることができる。

本発明の他の好適な実施形態によれば、出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部を制御する光制御装置が実行する制御方法であって、少なくとも所定の対象物の位置を示す第１情報を取得する第１取得工程と、前記出射部を制御する制御工程と、を有し、前記制御工程は、前記移動体の現在位置情報と前記第１情報とに基づいて推定された前記所定の対象物が存在する第１方向については、他の方向とは異なる制御を行う。光制御装置は、この制御方法を実行することで、所定の対象物が存在すると推定された方向について、他の方向とは異なる光の出射制御を行うことができる。

本発明の他の好適な実施形態によれば、出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部を制御するコンピュータが実行するプログラムであって、少なくとも所定の対象物の位置を示す第１情報を取得する第１取得部と、前記出射部を制御する制御部として前記コンピュータを機能させ、前記制御部は、前記移動体の現在位置情報と前記第１情報とに基づいて推定された前記所定の対象物が存在する第１方向については、他の方向とは異なる制御を行う。コンピュータは、このプログラムを実行することで、所定の対象物が存在すると推定された方向について、他の方向とは異なる光の出射制御を行うことができる。好適には、上記プログラムは、記憶媒体に記憶される。

本発明の他の好適な実施形態によれば、光制御装置は、出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部と、少なくとも所定の対象物の位置を示す第１情報を取得する第１取得部と、前記移動体の現在位置情報と前記第１情報とに基づいて、前記光を第１の出射頻度で出射する第１出射モードと、前記光を第１の出射頻度よりも低い頻度である第２出射モードと、を切り換えて前記出射部を制御する制御部と、を備える。この態様により、光制御装置は、所定の対象物の位置に応じて光の出射頻度を切り替えることができるため、所定の対象物に対して効率的かつ高密度に光を照射させることができる。

以下、図面を参照して本発明の好適な実施例について説明する。

［全体構成］
図１は、本実施例に係るライダユニット１００のブロック構成図である。図１に示すライダユニット１００は、ＴＯＦ（Ｔｉｍｅ Ｏｆ Ｆｌｉｇｈｔ）方式のライダ（Ｌｉｄａｒ：Ｌｉｇｈｔ Ｄｅｔｅｃｔｉｏｎ ａｎｄ Ｒａｎｇｉｎｇ、または、Ｌａｓｅｒ Ｉｌｌｕｍｉｎａｔｅｄ Ｄｅｔｅｃｔｉｏｎ Ａｎｄ Ｒａｎｇｉｎｇ）であって、水平方向の全方位における物体の測距を行うことで、自動運転等に必要な現在位置の高精度な推定を行う。ライダユニット１００は、主に、光送受信部１と、ランドマーク位置予測部２と、ランドマーク地図取得部３と、信号処理部４と、ランドマーク位置計測部５と、自己位置推定部６と、車速センサ８と、ジャイロセンサ９とを有する。以後では、処理基準となる現在時刻を「時刻ｔ」、時刻ｔの一つ前の処理フレームの実行時刻を「時刻ｔ−１」と表記する。

光送受信部１は、出射方向を徐変させながら水平方向の３６０°の全方位を対象にパルスレーザを出射する。このとき、光送受信部１は、水平方向の３６０°の全方位を区切ったセグメント（本実施例では９００〜４５００セグメント）ごとにパルスレーザを出射する。この場合、後述するように、光送受信部１は、ランドマーク位置予測部２から通知された所定の出射範囲については、他の範囲よりも、セグメント間の角度差を小さくして光パルスの出射レートを高くする。そして、光送受信部１は、パルスレーザ出射後の所定期間内に当該パルスレーザの反射光を受光することで生成したセグメントごとの受光強度に関する信号（「セグメント信号Ｓｓｅｇ」とも呼ぶ。）を、信号処理部４へ出力する。

ランドマーク位置予測部２は、時刻ｔでのライダユニット１００の位置（「自己位置」とも呼ぶ。）を予測し、予測した時刻ｔでの自己位置から、自己位置を推定するための目印となる所定の対象物（「ランドマーク」とも呼ぶ。）が検出される方向を予測する。なお、ランドマーク位置予測部２が予測する時刻ｔの自己位置は、後述する自己位置推定部６が推定する自己位置よりも精度が低い暫定的な位置である。ランドマークは、例えば、道路脇に周期的に並んでいるキロポスト、１００ｍポスト、デリニエータ、交通インフラ設備（例えば標識、方面看板、信号）、電柱、街灯などの所定の地物である。ランドマークは、本発明における「所定の対象物」の一例である。

この場合、まず、ランドマーク位置予測部２は、後述する自己位置推定部６が推定した時刻ｔ−１での自己位置の推定値と、車速センサ８が出力する移動速度及びジャイロセンサ９が出力する角速度とに基づき、時刻ｔでの自己位置の予測値を公知の算出方法により算出する。この場合、ランドマーク位置予測部２は、自己位置の予測値として、例えば緯度、経度、進行方向の方位の各予測値をそれぞれ算出する。なお、ランドマーク位置予測部２は、地磁気センサなどの方位を検出するセンサをライダユニット１００が有している場合には、緯度及び経度の各予測値のみを算出してもよい。次に、ランドマーク位置予測部２は、算出した自己位置の予測値から測距可能距離内にあるランドマークに関する情報（「ランドマーク情報ＩＬ」とも呼ぶ。）をランドマーク地図取得部３に取得させる。ランドマーク情報ＩＬは、ランドマークごとの位置情報及びレーザの反射率に関する情報（反射率情報）が含まれている。そして、ランドマーク位置予測部２は、ランドマーク地図取得部３が取得したランドマーク情報ＩＬに含まれる位置情報から、ランドマークが存在する光送受信部１のスキャン角度の予測範囲（「予測角度範囲Ｒｔａｇ」とも呼ぶ。）を設定する。ランドマーク位置予測部２は、本発明における「決定部」の一例であり、ランドマーク位置予測部２が参照するランドマーク情報ＩＬの位置情報は、本発明における「第１情報」の一例であり、予測角度範囲Ｒｔａｇは、本発明における「第１方向」の一例である。

ランドマーク地図取得部３は、ランドマーク位置予測部２から指定された範囲に存在するランドマークのランドマーク情報ＩＬを取得する。この場合、ランドマーク地図取得部３は、図示しない記憶部に予め記憶された地図情報からランドマーク情報ＩＬを抽出してもよく、地図情報を有する図示しないサーバ装置から通信によりランドマーク情報ＩＬを取得してもよい。ランドマーク位置予測部２及びランドマーク地図取得部３は、本発明における「第１取得部」の一例である。

信号処理部４は、光送受信部１から受信したセグメントごとのセグメント信号Ｓｓｅｇの波形からピーク位置をそれぞれ検出し、検出したピーク位置に基づきレーザの照射物までの距離を算出する。そして、信号処理部４は、セグメントごとに算出した距離と、当該セグメントに対応するスキャン角度との組み合わせである計測点の情報（「計測データＤｍ」とも呼ぶ。）を、ランドマーク位置計測部５へ供給する。

ランドマーク位置計測部５は、計測データＤｍを信号処理部４から受信した場合に、計測データＤｍが示す全ての計測点から、ランドマーク位置予測部２が予測角度範囲Ｒｔａｇを設定する基準としたランドマークに対応する計測点を抽出する。そして、ランドマーク位置計測部５は、抽出した計測点と、ランドマーク位置予測部２が算出した自己位置の予測値とに基づき、対象のランドマークの絶対的な位置を算出し、算出したランドマークの位置（「ランドマーク計測位置Ｐ_ＬＭ」とも呼ぶ。）を自己位置推定部６へ供給する。

自己位置推定部６は、ランドマーク位置計測部５から供給されるランドマーク計測位置Ｐ_ＬＭと、ランドマーク地図取得部３が取得したランドマーク情報ＩＬが示すランドマークの地図上の位置とに基づき、現時刻ｔにおける自己位置の推定値（「推定自己位置Ｐｅ」とも呼ぶ。）を算出する。この場合、自己位置推定部６は、例えば、ランドマーク計測位置Ｐ_ＬＭと、ランドマーク情報ＩＬに基づく地図上の位置との差異に基づき、ランドマーク位置予測部２が算出した自己位置の予測値を補正することで、推定自己位置Ｐｅを算出する。これにより、自己位置推定部６は、ランドマーク位置予測部２が予測角度範囲Ｒｔａｇを設定するために算出した自己位置の予測値よりも高精度な推定自己位置Ｐｅを算出する。ここで、自己位置推定部６は、推定自己位置Ｐｅとして、例えば緯度、経度、進行方向の方位の各推定値をそれぞれ算出し、地磁気センサなどの方位を検出するセンサをライダユニット１００が有している場合には、緯度及び経度の各推定値のみを算出する。自己位置推定部６は、算出した推定自己位置Ｐｅを、ランドマーク位置予測部２に供給すると共に、外部ユニット（例えば自動運転を制御するユニット等）に推定自己位置Ｐｅを供給する。

［光送受信部の構成］
図２は、光送受信部１の概略的な構成例を示す。図２に示すように、光送受信部１は、主に、水晶発振器１０と、同期制御部１１と、ＬＤドライバ１２と、レーザダイオード１３と、スキャナ１４と、モータ制御部１５と、受光素子１６と、電流電圧変換回路（トランスインピーダンスアンプ）１７と、Ａ／Ｄコンバータ１８と、可変セグメンテータ１９とを有する。

水晶発振器１０は、同期制御部１１及びＡ／Ｄコンバータ１８にパルス状のクロック信号「Ｓ１」を出力する。本実施例では、一例として、クロック周波数は、１．８ＧＨｚであるものとする。また、以後では、クロック信号Ｓ１が示すクロックを「サンプルクロック」とも呼ぶ。

同期制御部１１は、パルス状のトリガ信号（「可変パルストリガ信号Ｓ２」とも呼ぶ。）をＬＤドライバ１２に出力する。ここで、同期制御部１１は、ランドマーク位置予測部２から供給される予測角度範囲Ｒｔａｇに基づき、可変パルストリガ信号Ｓ２をアサートする周期を決定する。本実施例では、同期制御部１１は、可変パルストリガ信号Ｓ２を周期的にアサートする時間間隔を、１３１０７２（＝２^１７）サンプルクロック分の時間幅、又は、２６２１４サンプルクロック分の時間幅のいずれかに設定する。この場合、クロック周波数を「ｆｓｍｐ」（＝１．８ＧＨｚ）とすると、可変パルストリガ信号Ｓ２のパルスレート「ｆｓｅｇ」は、「ｆｓｍｐ／１３１０７２」又は「ｆｓｍｐ／２６２１４」となる。以後では、可変パルストリガ信号Ｓ２がアサートされてから次にアサートされるまでの期間を「セグメント期間」とも呼ぶ。後述するように、同期制御部１１は、予測角度範囲Ｒｔａｇ内のスキャン角度に相当するセグメントについては、他のセグメントよりもセグメント期間が短くなるように、可変パルストリガ信号Ｓ２を生成する。

また、同期制御部１１は、後述する可変セグメンテータ１９がＡ／Ｄコンバータ１８の出力を抽出するタイミングを定める信号（「セグメント抽出信号Ｓ３」とも呼ぶ。）を可変セグメンテータ１９に出力する。可変パルストリガ信号Ｓ２及びセグメント抽出信号Ｓ３は、論理信号であり、後述する図３に示すように同期している。本実施例では、同期制御部１１は、セグメント抽出信号Ｓ３を、２０４８サンプルクロック分の時間幅（「ゲート幅Ｗｇ」とも呼ぶ。）だけアサートする。同期制御部１１は、本発明における「制御部」の一例である。また、同期制御部１１及びランドマーク位置予測部２等は、本発明におけるプログラムを実行するコンピュータの一例である。

ＬＤドライバ１２は、同期制御部１１から入力される可変パルストリガ信号Ｓ２に同期してパルス電流をレーザダイオード１３へ流す。レーザダイオード１３は、例えば赤外（９０５ｎｍ）パルスレーザであって、ＬＤドライバ１２から供給されるパルス電流に基づき光パルスを出射する。本実施例では、レーザダイオード１３は、５ｎｓｅｃ程度の光パルスを出射する。

スキャナ１４は、送出及び受信光学系の構成を含み、レーザダイオード１３が出射する光パルスを水平面で３６０°走査すると共に、出射された光パルスが照射された物体で反射された戻り光を受光素子１６に導く。本実施例では、スキャナ１４は、回転するためのモータを含み、モータは、９００〜４５００セグメントで一回転するように、モータ制御部１５により制御される。この場合の角度分解能は、セグメント数が９００の場合には、１セグメントあたり０．４°（＝３６０°／９００）となり、セグメント数が４５００の場合には、１セグメントあたり０．０８°（＝３６０°／４５００）となる。

好適には、スキャナ１４のスキャン面は、傘状ではなく平面であることが望ましく、かつ、ライダユニット１００が移動体に搭載される場合には、移動体が走行する地表に対して平行（即ち水平）であることが望ましい。ＬＤドライバ１２及びレーザダイオード１３及びスキャナ１４は、本発明における「出射部」の一例である。

受光素子１６は、例えば、アバランシェフォトダイオードであり、スキャナ１４により導かれた反射光の光量に応じた微弱電流を生成する。受光素子１６は、生成した微弱電流を、電流電圧変換回路１７へ供給する。電流電圧変換回路１７は、受光素子１６から供給された微弱電流を増幅して電圧信号に変換し、変換した電圧信号をＡ／Ｄコンバータ１８へ入力する。

Ａ／Ｄコンバータ１８は、水晶発振器１０から供給されるクロック信号Ｓ１に基づき、電流電圧変換回路１７から供給される電圧信号をデジタル信号に変換し、変換したデジタル信号を可変セグメンテータ１９に供給する。以後では、Ａ／Ｄコンバータ１８が１クロックごとに生成するデジタル信号を「サンプル」とも呼ぶ。受光素子１６、電流電圧変換回路１７及びＡ／Ｄコンバータ１８は、本発明における「受光部」の一例である。

可変セグメンテータ１９は、セグメント抽出信号Ｓ３がアサートされているゲート幅Ｗｇ分の期間における２０４８サンプルクロック分のＡ／Ｄコンバータ１８の出力であるデジタル信号を、セグメント信号Ｓｓｅｇとして生成する。可変セグメンテータ１９は、生成したセグメント信号Ｓｓｅｇを信号処理部４へ供給する。

図３は、可変パルストリガ信号Ｓ２及びセグメント抽出信号Ｓ３の時系列での波形を示す。図３に示すように、本実施例では、可変パルストリガ信号Ｓ２がアサートされる１周期分の期間であるセグメント期間は、２６２１４サンプルクロック（図面では「ｓｍｐｃｌｋ」と表記）分の長さ、又は、１３１０７２サンプルクロック分の長さに設定され、可変パルストリガ信号Ｓ２のパルス幅は６４サンプルクロック分の長さ、ゲート幅Ｗｇは２０４８サンプルクロック分の長さに設定されている。

この場合、可変パルストリガ信号Ｓ２がアサートされた後のゲート幅Ｗｇの期間だけセグメント抽出信号Ｓ３がアサートされているため、可変セグメンテータ１９は、可変パルストリガ信号Ｓ２がアサート中の２０４８個分のＡ／Ｄコンバータ１８が出力するサンプルを抽出することになる。そして、ゲート幅Ｗｇが長いほど、ライダユニット１００からの最大測距距離（測距限界距離）が長くなる。

本実施例では、最大測距距離は、単純計算した場合、ゲート幅Ｗｇに相当する時間幅で光が往復する距離に相当する１７０．５５ｍ（≒｛２０４８／１．８ＧＨｚ｝・ｃ／２、「ｃ」は光速）となる。なお、最大測距距離は、電気的及び光学的な遅れを考慮したオフセットを設定するため、１７０．５５ｍよりも若干短くなる。

［パルスレートの設定］
次に、パルスレートｆｓｅｇの設定方法について説明する。概略的には、同期制御部１１は、予測角度範囲Ｒｔａｇに属するスキャン角度に対応するセグメントのパルスレートｆｓｅｇを、他のセグメントのパルスレートｆｓｅｇよりも高くなるように、可変パルストリガ信号Ｓ２及びセグメント抽出信号Ｓ３を生成する。

図４は、予測角度範囲Ｒｔａｇに属しないスキャン角度に対応するセグメントの可変パルストリガ信号Ｓ２の波形を示す。また、図５は、予測角度範囲Ｒｔａｇに属するスキャン角度に対応するセグメントの可変パルストリガ信号Ｓ２の波形を示す。

図４及び図５の例では、同期制御部１１は、予測角度範囲Ｒｔａｇに属しないスキャン角度に対応するセグメントについては、パルスレートｆｓｅｇを約１３．７ｋＨｚに設定している。一方、同期制御部１１は、予測角度範囲Ｒｔａｇに属しないスキャン角度に対応するセグメントについては、パルスレートｆｓｅｇを約６８．５ｋＨｚ（即ち１３．７ｋＨｚの５倍）に設定している。このように、同期制御部１１は、予測角度範囲Ｒｔａｇ内については、パルスレートｆｓｅｇを相対的に高くすることで、走査密度を高くする。これにより、同期制御部１１は、対象となるランドマークの計測点を高密度に取得することができる。

図６は、５０ｍ先のランドマーク７０の存在が推定される予測角度範囲Ｒｔａｇ内において、パルスレートｆｓｅｇを予測角度範囲Ｒｔａｇ外と同一である約１３．７ｋＨｚ（図４参照）に固定して光パルスを出射した場合の光パルスの光路を示す。また、図７は、ランドマーク７０の存在が推定される予測角度範囲Ｒｔａｇ内において、パルスレートｆｓｅｇを図６の例の５倍の約６８．５ｋＨｚ（図５参照）に上げて光パルスを出射した場合の光パルスの光路を示す。ここでは、ランドマーク７０の横幅は、０．４ｍであるものとする。

図６に示すように、パルスレートｆｓｅｇを予測角度範囲Ｒｔａｇ外と同一である約１３．７ｋＨｚに仮に設定した場合、ランドマーク７０に照射される光パルスは１つとなる。よって、この場合、ランドマーク７０に対する計測点は１個しか得られない。これに対し、図７に示すように、パルスレートｆｓｅｇを約６８．５ｋＨｚ（図５参照）に上げて光パルスを出射した場合、ランドマーク７０に照射される光パルスは８つとなり、計測点が８個得られることになる。この場合、ランドマーク位置計測部５は、得られた８個の計測点から、ランドマーク７０の形状、構造、向き等を認識し、高精度にランドマーク７０に対するランドマーク計測位置Ｐ_ＬＭを算出することが可能となる。

好適には、同期制御部１１は、予測角度範囲Ｒｔａｇ内でのパルスレートｆｓｅｇを上げる場合には、パルス光のピークパワーを通常よりも下げるように制御するとよい。一般に、パルス光が人間の目に入っても安全なアイセーフの基準は、空間中の任意の場所での単位面積あたりのパルス光の平均パワーによって決まる。また、一般に、単位面積あたりのパルス光の平均パワーは、パルス光の出射レートが高いほど高くなり、パルス光のピークパワーが低いほど低くなる。以上を勘案し、同期制御部１１は、パルスレートｆｓｅｇを上げる場合には、出射させるパルス光のピークパワーを低下させる。図５の例では、図４の例と比較して、パルスレートｆｓｅｇが高い分、パルス光のピークパワーに相当するパルスの高さが低く設定されている。このようにすることで、予測角度範囲Ｒｔａｇ内でパルスレートｆｓｅｇを上げた場合であっても、空間中の任意の場所での単位面積あたりのパルス光の平均パワーの上昇を抑制して好適にアイセーフを実現することができる。

この場合、さらに好適には、同期制御部１１は、ランドマーク情報ＩＬに含まれる反射率情報を参照し、対象のランドマークの反射率が所定率以上の場合にのみ、予測角度範囲Ｒｔａｇ内において、パルス光のピークパワーを通常よりも下げるように制御するとよい。この場合の所定率は、例えば、パルス光のピークパワーを通常よりも下げた場合であってもその反射光に基づきライダユニット１００が計測点を生成可能な反射率の下限値等に、実験等に基づき予め設定される。このようにすることで、同期制御部１１は、パルス光のピークパワーを通常よりも下げることによってランドマークの計測点が生成できなくなるのを好適に抑制することができる。

［処理フロー］
図８は、本実施例においてライダユニット１００が実行する処理手順を示すフローチャートである。

まず、ランドマーク位置予測部２は、前回の処理フレームで推定した時刻ｔ−１での推定自己位置Ｐｅが存在するか否か判定する（ステップＳ１０１）。そして、前回の処理フレームで推定した時刻ｔ−１での推定自己位置Ｐｅが存在する場合（ステップＳ１０１；Ｙｅｓ）、ランドマーク位置予測部２は、時刻ｔ−１での推定自己位置Ｐｅと、車速センサ８及びジャイロセンサ９から得られた車速及び角速度とに基づき、時刻ｔに対応する自己位置の予測値を算出する（ステップＳ１０２）。一方、前回の処理フレームで推定した時刻ｔ−１での推定自己位置Ｐｅが存在しない場合（ステップＳ１０１；Ｎｏ）、ランドマーク位置予測部２は、図示しないＧＰＳ受信機等の測位装置の出力に基づき、時刻ｔでの自己位置を予測する（ステップＳ１０３）。ステップＳ１０２又はＳ１０３で予測される現在位置の情報は、本発明における「現在位置情報」の一例である。

次に、ランドマーク位置予測部２は、地図情報に基づき、自己位置を推定する目印となるランドマークを検出するための予測角度範囲Ｒｔａｇを決定する（ステップＳ１０４）。この場合、ランドマーク位置予測部２は、ランドマーク地図取得部３に対して自己位置の予測値を供給することで、自己位置の予測値から測距可能距離以内に位置情報が登録されているランドマークのランドマーク情報ＩＬを、ランドマーク地図取得部３により取得する。

そして、光送受信部１は、光パルスによる走査を開始する（ステップＳ１０５）。このとき、光送受信部１は、出射する光パルスに対応するセグメントのスキャン角度が予測角度範囲Ｒｔａｇ内であるか否か判定する（ステップＳ１０６）。そして、光送受信部１は、出射する光パルスに対応するセグメントのスキャン角度が予測角度範囲Ｒｔａｇ内の場合（ステップＳ１０６；Ｙｅｓ）、高分解能による光パルスの走査を実行する（ステップＳ１０７）。即ち、この場合、光送受信部１は、図５及び図７で説明したように、パルスレートｆｓｅｇを通常よりも上げて光パルスによる走査密度を高める。なお、このとき、好適には、光送受信部１は、ランドマーク情報ＩＬが示す反射率情報が所定率以上である場合には、パルス光のピークパワーを下げる制御を行うとよい。この場合、反射率情報は、本発明における「第２情報」の一例であり、ランドマーク位置予測部２及びランドマーク地図取得部３は、本発明における「第２取得部」の一例である。

一方、光送受信部１は、出射する光パルスに対応するセグメントのスキャン角度が予測角度範囲Ｒｔａｇ外の場合（ステップＳ１０６；Ｎｏ）、通常分解能による光パルスの走査を実行する（ステップＳ１０８）。即ち、この場合、光送受信部１は、図４及び図６の例のように、通常のパルスレートｆｓｅｇにより光パルスを出射する。なお、ステップＳ１０７での光パルスの出射制御は、本発明における「第１出射モード」の一例であり、ステップＳ１０８での光パルスの出射制御は、本発明における「第２出射モード」の一例である。

そして、光送受信部１は、走査対象の全方位に対する光パルスの走査が終了したか否か判定する（ステップＳ１０９）。そして、光送受信部１は、走査対象の全方位に対する光パルスの走査が終了していない場合（ステップＳ１０９；Ｎｏ）、ステップＳ１０６を再び実行する。

一方、走査対象の全方位に対する光パルスの走査が終了した場合（ステップＳ１０９；Ｙｅｓ）、ランドマーク位置計測部５は、信号処理部４が出力する計測点からランドマークに対応する計測点を抽出し、抽出した計測点からランドマーク計測位置Ｐ_ＬＭを算出する（ステップＳ１１０）。この場合、ランドマーク位置計測部５は、例えば、予測角度範囲Ｒｔａｇ内のスキャン角度に対応する計測点を抽出し、抽出した計測点からランドマークの形状、構造、向きを特定することで、ランドマーク計測位置Ｐ_ＬＭを算出する。例えば、ランドマーク位置計測部５は、抽出した複数の計測点を代表する距離及びスキャン角度と、ステップＳ１０２又はステップＳ１０３で予測した自己位置とに基づき、ランドマークの緯度及び経度を算出し、ランドマーク計測位置Ｐ_ＬＭとして定める。

そして、自己位置推定部６は、ランドマーク位置計測部５が算出したランドマーク計測位置Ｐ_ＬＭに基づき、推定自己位置Ｐｅを算出する（ステップＳ１１１）。この場合、自己位置推定部６は、例えば、所定の式又はマップを参照し、ランドマーク計測位置Ｐ_ＬＭと、ランドマーク地図取得部３が取得したランドマーク情報ＩＬが示す位置との差異に基づき、ステップＳ１０２又はステップＳ１０３で予測した自己位置の予測値を補正することで、推定自己位置Ｐｅを算出する。

以上説明したように、本実施例に係るライダユニット１００は、出射部に相当するＬＤドライバ１２及びレーザダイオード１３及びスキャナ１４と、受光部に相当する受光素子１６及び電流電圧変換回路１７及びＡ／Ｄコンバータ１８と、地図上でのランドマークの位置を示す位置情報を取得するランドマーク位置予測部２及びランドマーク地図取得部３と、可変パルストリガ信号Ｓ２及びセグメント抽出信号Ｓ３を生成する同期制御部１１とを有する。ランドマーク位置予測部２は、車両の現在位置の予測値と地図上でのランドマークの位置とに基づき、ランドマークの存在が予測される予測角度範囲Ｒｔａｇを設定する。同期制御部１１は、予測角度範囲Ｒｔａｇについては、他の範囲よりも光パルスの走査密度が高くなるように可変パルストリガ信号Ｓ２及びセグメント抽出信号Ｓ３を生成する。これにより、ライダユニット１００は、自己位置を推定するのに必要なランドマークを高精度に検出し、自己位置を高精度に推定することができる。

［変形例］
次に、実施例に好適な変形例について説明する。以下の変形例は、任意に組み合わせて上述の実施例に適用してもよい。

（変形例１）
図８のステップＳ１０８において、同期制御部１１は、予測角度範囲Ｒｔａｇ外のスキャン角度に対応するセグメントについては光パルスを出射しないように可変パルストリガ信号Ｓ２を生成してもよい。この場合、同期制御部１１は、予測角度範囲Ｒｔａｇ内のスキャン角度に対応するセグメントについては、実施例の図８のステップＳ１０７と同様に、ランドマークの計測点を得るのに十分なパルスレートｆｓｅｇに設定するように可変パルストリガ信号Ｓ２をアサートさせる。一方、同期制御部１１は、予測角度範囲Ｒｔａｇ外のスキャン角度に対応するセグメントについては、可変パルストリガ信号Ｓ２をアサートさせない。これにより、ライダユニット１００は、予測角度範囲Ｒｔａｇ以外については光パルスを走査しない。

この態様によれば、ライダユニット１００は、検出対象であるランドマークが存在しないスキャン方向に対応する計測点を不要に生成するのを防ぎ、処理負荷を好適に低減させることができる。

（変形例２）
光送受信部１は、予測角度範囲Ｒｔａｇ内でのパルスレートｆｓｅｇを上げる代わりに、予測角度範囲Ｒｔａｇ内での光パルスの走査速度を遅くしてもよい。

この場合、同期制御部１１は、予測角度範囲Ｒｔａｇによらずにパルスレートｆｓｅｇを固定にした固定パルストリガ信号を生成し、ＬＤドライバ１２へ供給する。一方、モータ制御部１５は、ランドマーク位置予測部２から予測角度範囲Ｒｔａｇを受信し、予測角度範囲Ｒｔａｇ内のスキャン角度でスキャナ１４を動作させる際の走査速度を、予測角度範囲Ｒｔａｇ内のスキャン角度でスキャナ１４を動作させる際の走査速度よりも遅くする。この場合、モータ制御部１５は、本発明における「制御部」の一例である。これによっても、光送受信部１は、好適に、ランドマークの存在が予想される予測角度範囲Ｒｔａｇ内での走査密度を高くし、自己位置推定の基準とするランドマークの計測点を高密度に取得することができる。

（変形例３）
同期制御部１１は、予測角度範囲Ｒｔａｇ内でのパルスレートｆｓｅｇの設定値を、複数段階に分けてもよい。例えば、同期制御部１１は、予測角度範囲Ｒｔａｇのうち、予測角度範囲Ｒｔａｇの中心角度から所定角度以内となる範囲とその他の範囲とに分け、前者の範囲パルスレートｆｓｅｇを後者の範囲のパルスレートｆｓｅｇよりも高く設定する。このように、予測角度範囲Ｒｔａｇ内でパルスレートｆｓｅｇの設定値を複数段階に分けることで、ランドマークの存在可能性が高い予測角度範囲Ｒｔａｇ内での走査密度を高くし、ランドマークの計測点を効率的かつ高精度に取得することができる。

（変形例４）
ライダユニット１００は、２以上のランドマークを対象にランドマーク計測位置Ｐ_ＬＭをそれぞれ算出し、推定自己位置Ｐｅを決定してもよい。

この場合、光送受信部１は、例えば、それぞれのランドマークに対して予測角度範囲Ｒｔａｇを設定し、ランドマーク位置計測部５は、設定された予測角度範囲Ｒｔａｇからそれぞれのランドマークに対応する計測点を抽出し、ランドマーク計測位置Ｐ_ＬＭをそれぞれ算出する。そして、自己位置推定部６は、ランドマークごとに、ランドマーク計測位置Ｐ_ＬＭと地図上の位置との差異を算出し、これらの差異に基づき公知の補間処理などを適用して、自己位置の予測値の補正量を決定する。

（変形例５）
ライダユニット１００は、スキャナ１４による水平方向の走査を鉛直方向の複数列（レイヤ）について繰り返す形態（即ち多層ライダ）であってもよい。この場合、例えば、ライダユニット１００は、任意のひとつのレイヤに対して実施例の処理を実行して推定自己位置Ｐｅを算出する。なお、ランドマーク位置計測部５は、予測角度範囲Ｒｔａｇ内での各レイヤにおけるランドマークの計測点を抽出し、ランドマークの各高さでの形状等のマッチング処理に用いてもよい。

（変形例６）
図２に示す光送受信部１の構成は一例であり、本発明が適用可能な構成は、図２に示す構成に限定されない。例えば、レーザダイオード１３及びモータ制御部１５は、スキャナ１４と共に回転する構成であってもよい。

（変形例７）
ライダユニット１００は、実施例で説明した自己位置推定処理に加えて周辺環境の認識処理を行う場合、処理フレームごとに、予測角度範囲Ｒｔａｇに応じてパルスレートｆｓｅｇを変化させる場合と、パルスレートｆｓｅｇを予測角度範囲Ｒｔａｇによらずに固定値にする場合とを交互に切り替えて実行してもよい。これにより、パルスレートｆｓｅｇを上げると共に光パルスのピークパワーを下げた際に、低反射率物体が見つけにくくなるのを防ぐことができる。

１ 光送受信部
２ ランドマーク位置予測部
３ ランドマーク地図取得部
４ 信号処理部
５ ランドマーク位置計測部
６ 自己位置推定部
８ 車速センサ
９ ジャイロセンサ
１００ ライダユニット

Claims (7)

1. 出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部と、
   少なくとも所定の対象物の位置を示す第１情報を取得する第１取得部と、
   前記所定の対象物の光の反射率に関連する情報であって、地図情報に記憶された第２情報を、前記地図情報から取得する第２取得部と、
   前記出射部を制御する制御部と、を備え、
   前記制御部は、前記移動体の現在位置情報と前記第１情報とに基づいて推定された前記所定の対象物が存在する第１方向については、前記第２情報が示す前記所定の対象物の光の反射率に応じた強度で前記光を出射するように、前記出射部を制御する光制御装置。
2. 前記制御部は、前記光の反射率が所定率以上の場合に、前記第１方向については、他の方向よりも、前記光の強度を低くする制御を行う請求項１に記載の光制御装置。
3. 前記制御部は、前記第１方向については、他の方向よりも、前記光のパルスレートを上げることで前記光の出射頻度を上げる請求項１に記載の光制御装置。
4. 前記制御部は、前記第１方向については、他の方向よりも走査速度を遅くするように前記出射部を制御する請求項１に記載の光制御装置。
5. 出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部を制御する光制御装置が実行する制御方法であって、
   少なくとも所定の対象物の位置を示す第１情報を取得する第１取得工程と、
   前記所定の対象物の光の反射率に関連する情報であって、地図情報に記憶された第２情報を、前記地図情報から取得する第２取得工程と、
   前記出射部を制御する制御工程と、を有し、
   前記制御工程は、前記移動体の現在位置情報と前記第１情報とに基づいて推定された前記所定の対象物が存在する第１方向については、前記第２情報が示す前記所定の対象物の光の反射率に応じた強度で前記光を出射するように、前記出射部を制御する制御方法。
6. 出射方向を変えながら光を出射する出射部と前記光を受光する受光部とを有する送受光部を制御するコンピュータが実行するプログラムであって、
   少なくとも所定の対象物の位置を示す第１情報を取得する第１取得部と、
   前記所定の対象物の光の反射率に関連する情報であって、地図情報に記憶された第２情報を、前記地図情報から取得する第２取得部と、
   前記出射部を制御する制御部
   として前記コンピュータを機能させ、
   前記制御部は、前記移動体の現在位置情報と前記第１情報とに基づいて推定された前記所定の対象物が存在する第１方向については、前記第２情報が示す前記所定の対象物の光の反射率に応じた強度で前記光を出射するように、前記出射部を制御するプログラム。
7. 請求項６に記載のプログラムを記憶した記憶媒体。

Images