特開 2023-68010 自己位置推定装置

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公開特許公報(A)

(11)【公開番号】P2023068010

(43)【公開日】2023-05-16

(54)【発明の名称】自己位置推定装置

(51)【国際特許分類】

   G01C 21/30 20060101AFI20230509BHJP

   G08G 1/0969 20060101ALI20230509BHJP

   G09B 29/10 20060101ALI20230509BHJP

【ＦＩ】

G01C21/30

G08G1/0969

G09B29/10 A

【審査請求】有

【請求項の数】8

【出願形態】ＯＬ

(21)【出願番号】P 2023037170

(22)【出願日】2023-03-10

(62)【分割の表示】P 2018159020の分割

【原出願日】2018-08-28

(71)【出願人】

【識別番号】000005016

【氏名又は名称】パイオニア株式会社

(74)【代理人】

【識別番号】100134832

【弁理士】

【氏名又は名称】瀧野 文雄

(74)【代理人】

【識別番号】100165308

【弁理士】

【氏名又は名称】津田 俊明

(74)【代理人】

【識別番号】100115048

【弁理士】

【氏名又は名称】福田 康弘

(72)【発明者】

【氏名】小山 和紀

(72)【発明者】

【氏名】松本 令司

(72)【発明者】

【氏名】天野 克巳

(72)【発明者】

【氏名】乘松 直人

(57)【要約】

【課題】移動体の自己位置推定の精度を向上させることができる自己位置推定装置を提供する。
【解決手段】車載装置２は、路面に描かれた標示が複数のセルＣで分割されて表されており、複数のセルＣのそれぞれには、当該セルＣの位置１３２が設定されている地図データを、制御部２１が取得し、車両走行によってライダ３ａから得られた点群情報を取得する。そして、制御部２１が取得した点群情報から路面に描かれた標示に該当する点群情報を認識し、認識された路面に描かれた標示に該当する点群情報と、地図データと、のマッチングを行うことにより車両の自己位置を推定する。
【選択図】図９

【特許請求の範囲】

【請求項1】

路面に描かれた標示が一定サイズの複数のセルで分割されて表されており、前記複数のセルのそれぞれには、当該セルの位置に関する情報が設定されている地図データ、を取得する地図データ取得部と、
移動体に搭載されたセンサから得られたセンサ情報を取得するセンサ情報取得部と、
前記センサ情報取得部が取得した前記センサ情報から前記標示に該当する前記センサ情報を認識する認識部と、
前記認識部により認識された前記標示に該当する前記センサ情報と、前記地図データと、のマッチングを行うことにより前記移動体の自己位置を推定する推定部と、
を備え、
前記セル毎に、当該セルに対応する点群の反射強度に関する情報を含む属性情報を有している、
ことを特徴とする自己位置推定装置。

【請求項2】

移動体の自己位置を推定する自己位置推定装置で実行される自己位置推定方法であって、
路面に描かれた標示が一定サイズの複数のセルで分割されて表されており、前記複数のセルのそれぞれには、当該セルの位置に関する情報が設定されている地図データ、を取得する地図データ取得工程と、
前記移動体に搭載されたセンサから得られたセンサ情報を取得するセンサ情報取得工程と、
前記センサ情報取得工程で取得された前記センサ情報から前記標示に該当する前記センサ情報を認識する認識工程と、
前記認識工程により認識された前記標示に該当する前記センサ情報と、前記地図データと、のマッチングを行うことにより前記移動体の自己位置を推定する推定工程と、
を含み、
前記セル毎に、当該セルに対応する点群の反射強度に関する情報を含む属性情報を有している、
ことを特徴とする自己位置推定方法。

【請求項3】

請求項２に記載の自己位置推定方法を、コンピュータにより実行させることを特徴とする自己位置推定プログラム。

【請求項4】

請求項３に記載の自己位置推定プログラムを格納したことを特徴とするコンピュータ読み取り可能な記録媒体。

【請求項5】

路面を検知領域に含むセンサから得られたセンサ情報を取得する取得部と、
前記センサ情報に基づいて、前記路面に描かれた標示を一定サイズの複数のセルに分割し、且つ前記複数のセルのそれぞれに当該セルの位置に関する情報が設定されている地図データを生成する生成部と、
を備え、
前記セルは、当該セルに対応する点群の反射強度に関する情報を含む属性情報を有している、
ことを特徴とする地図データ生成装置。

【請求項6】

前記生成部は、前記反射強度に関する情報に基づいて前記セルを生成することを特徴とする請求項５に記載の地図データ生成装置。

【請求項7】

前記生成部は、前記反射強度に関する情報に基づいて二値化情報を生成し、前記二値化情報に基づいて前記セルを生成することを特徴とする請求項６に記載の地図データ生成装置。

【請求項8】

前記生成部は、前記路面外の前記反射強度に関する情報を除去した後に前記セルを生成することを特徴とする請求項６または７に記載の地図データ生成装置。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、移動体の自己位置を推定する自己位置推定装置に関する。

【背景技術】

【0002】

自動運転車両等の移動体では、ライダ（ＬｉＤＡＲ；Light Detection and Ranging）などのセンサで計測した地物位置と、自動運転用の地図情報の地物位置と、をマッチングして高精度に現在位置を推定する必要がある。特許文献１は、ライダを用いて検出したランドマークとしての地物の位置と、地図情報の地物とを用いて現在位置を推定する手法の一例が記載されている。

【0003】

また、特許文献２には、ライダを用いて白線を検出し、車両に対する白線の横方向の相対位置または白線に対して車両が向いている方向を高精度に検出することが記載されている。

【先行技術文献】

【特許文献】

【0004】

【特許文献1】特開２０１７－７２４２２号公報

【特許文献2】特開２０１７－２１５１９９号公報

【発明の概要】

【発明が解決しようとする課題】

【0005】

特許文献２に記載の方法により、白線（区画線）を利用して車両等の自己位置を推定することはできる。しかしながら、例えば、右折や左折等を示す進行方向別通行区分のような路面上に白線以外の標示がある場合に、当該標示を白線と誤って検出してしまうと自己位置推定の精度が低下してしまう。

【0006】

本発明が解決しようとする課題としては、移動体の自己位置推定の精度を向上させることが一例として挙げられる。

【課題を解決するための手段】

【0007】

上記課題を解決するために、請求項１に記載の発明は、路面に描かれた標示が一定サイズの複数のセルで分割されて表されており、前記複数のセルのそれぞれには、当該セルの位置に関する情報が設定されている地図データ、を取得する地図データ取得部と、移動体に搭載されたセンサから得られたセンサ情報を取得するセンサ情報取得部と、前記センサ情報取得部が取得した前記センサ情報から前記標示に該当する前記センサ情報を認識する認識部と、前記認識部により認識された前記標示に該当する前記センサ情報と、前記地図データと、のマッチングを行うことにより前記移動体の自己位置を推定する推定部と、
を備え、前記セル毎に、当該セルに対応する点群の反射強度に関する情報を含む属性情報を有している、ことを特徴としている。

【0008】

請求項２に記載の発明は、移動体の自己位置を推定する自己位置推定装置で実行される自己位置推定方法であって、路面に描かれた標示が一定サイズの複数のセルで分割されて表されており、前記複数のセルのそれぞれには、当該セルの位置に関する情報が設定されている地図データ、を取得する地図データ取得工程と、前記移動体に搭載されたセンサから得られたセンサ情報を取得するセンサ情報取得工程と、前記センサ情報取得工程で取得された前記センサ情報から前記標示に該当する前記センサ情報を認識する認識工程と、前記認識工程により認識された前記標示に該当する前記センサ情報と、前記地図データと、のマッチングを行うことにより前記移動体の自己位置を推定する推定工程と、を含み、前記セル毎に、当該セルに対応する点群の反射強度に関する情報を含む属性情報を有している、ことを特徴としている。

【0009】

請求項３に記載の発明は、請求項２に記載の自己位置推定方法を、コンピュータにより実行させることを特徴としている。

【0010】

請求項４に記載の発明は、請求項３に記載の自己位置推定プログラムを格納したことを特徴としている。

【図面の簡単な説明】

【0011】

【図1】本発明の第１の実施例にかかるサーバ装置と車載装置からなるシステムの概略構成図である。

【図2】図１に示されたサーバ装置の機能的構成図である。

【図3】図１に示された車載装置の機能的構成図である。

【図4】図２に示されたサーバ装置における地図データ生成方法のフローチャートである。

【図5】二値化画像の例である。

【図6】図５に示した二値化画像から不要なピクセルを除去した画像である。

【図7】本実施例におけるセルについての説明図である。

【図8】本発明の一実施例にかかる地図データ構造の説明図である。

【図9】図４に示されたフローチャートの変形例である。

【図10】白線を点列とした場合の説明図である。

【図11】本発明の一実施例にかかる自己位置推定方法のフローチャートである。

【図12】本発明の第２の実施例にかかる地図データ生成方法のフローチャートを示す。

【図13】図１２に示されたフローチャートの変形例である。

【発明を実施するための形態】

【0012】

以下、本発明の一実施形態にかかる自己位置推定装置を説明する。本発明の一実施形態にかかる自己位置推定装置は、路面に描かれた標示が複数のセルで分割されて表されており、複数のセルのそれぞれには、当該セルの位置に関する情報が設定されている地図データを、地図データ取得部が取得し、センサ情報取得部が車両走行によってセンサから得られたセンサ情報を取得する。そして、認識部がセンサ情報取得部で取得されたセンサ情報から路面に描かれた標示に該当するセンサ情報を認識し、推定部が認識部により認識された路面に描かれた標示に該当するセンサ情報と、地図データと、のマッチングを行うことにより車両の自己位置を推定する。このようにすることにより、路面に描かれた標示を利用して自己位置推定をすることができ、移動体の自己位置推定の精度を向上させることができる。

【0013】

また、セル毎に当該セルについての所定の属性情報を有してもよい。このようにすることにより、例えば、セル内における点群の分散や反射強度を属性情報として有するようにすれば、そのセルにおける標示を示すペイントの分布や割合等を把握することが可能となる、つまり、標示の輪郭が含まれるセルを特定することができる。

【0014】

また、本自己位置推定装置が対象とする路面に描かれた標示は、区画線を除く標示であってもよい。このようにすることにより、例えば白線等の区画線が既に他の方法によりデータ化されている場合は、白線等の区画線を除く、右折や左折等を示す進行方向別通行区分や最高速度といった道路標示について地図データに含めることが可能となる。

【0015】

また、本発明の一実施形態にかかる自己位置推定方法は、路面に描かれた標示が複数のセルで分割されて表されており、複数のセルのそれぞれには、当該セルの位置に関する情報が設定されている地図データを、地図データ取得工程で取得し、センサ情報取得工程で車両走行によってセンサから得られたセンサ情報を取得する。そして、認識工程でセンサ情報取得工程により取得されたセンサ情報から路面に描かれた標示に該当するセンサ情報を認識し、推定工程で認識工程により認識された路面に描かれた標示に該当するセンサ情報と、地図データと、のマッチングを行うことにより車両の自己位置を推定する。このようにすることにより、路面に描かれた標示を地図データに含めることができ、移動体の自己位置推定の精度を向上させることができる。

【0016】

また、本発明の一実施形態にかかる自己位置推定プログラムは、上述した自己位置推定方法を、コンピュータにより実行させている。このようにすることにより、コンピュータを用いて、路面に描かれた標示を地図データに含めることができ、移動体の自己位置推定の精度を向上させることができる。

【0017】

また、上述した自己位置推定プログラムをコンピュータ読み取り可能な記録媒体に格納してもよい。このようにすることにより、当該プログラムを機器に組み込む以外に単体でも流通させることができ、バージョンアップ等も容易に行える。

【実施例0018】

本発明の第１の実施例にかかる地図データ生成装置及び地図データ構造を図１～図１１を参照して説明する。本実施例にかかる地図データ生成装置は、図１ではサーバ装置１として構成されている。サーバ装置１は、移動体としての車両Ｖに搭載されている車載装置２が収集した情報をインターネット等のネットワークＮを介して取得し、取得した情報に基づいて後述する地図データ構造を有する地図データを生成する。

【0019】

図２にサーバ装置１の機能的構成を示す。サーバ装置１は、図２に示したように、制御部１１と、通信部１２と、記憶部１３と、を備えている。制御部１１は、サーバ装置１のＣＰＵ（Central Processing Unit）が機能し、サーバ装置１の全体制御を司る。制御部１１は、車載装置２から送信された例えば点群情報に基づいて地図データを生成する。

【0020】

通信部１２は、サーバ装置１のネットワークインターフェース等が機能し、車載装置２が送信した例えば点群情報を受信する。また、通信部１２は、制御部１１で生成された地図データを、車両Ｖの車載装置２へ配信（送信）する。即ち、サーバ装置１は、地図データが格納されている記憶装置として機能する。

【0021】

記憶部１３は、サーバ装置１のハードディスク等の記憶媒体が機能し、制御部１１で生成された地図データ等を記憶する。なお、記憶媒体としては、光ディスクやメモリーカード等のであってもよい。

【0022】

図３に車載装置２の機能的構成を示す。車載装置２は、図３に示したように、制御部２１と、通信部２２と、記憶部２３と、を備えている。また、車載装置２は、図３に示したように、ライダ３ａやＧＰＳ（Global Positioning System）受信機３ｂ等を含む車両Ｖに搭載されたセンサ３が接続されている。

【0023】

制御部２１は、例えばＣＰＵやメモリ等を有するマイクロコンピュータで構成され、車載装置２の全体制御を司る。制御部２１は、センサ３で検出された点群情報等を通信部１２からサーバ装置１へ送信させる。また、制御部２１は、ライダ３ａを用いて認識した路面上に描かれた標示等の地物を示す情報と、サーバ装置１で生成された後述する地図データ構造を有する地図データに含まれる路面上に描かれた標示等の情報と、に基づいて自己位置を推定する。また、制御部２１は、推定された自己位置に基づいて予め探索された経路に沿って車両Ｖを誘導（案内）する誘導装置（案内装置）の制御部として機能してもよい。この誘導装置には、車両Ｖを経路に沿って自律的に走行させる所謂自動運転機能と、ドライバ等に経路に沿った案内情報を提示するナビゲーション機能の少なくともいずれかを含むものである。

【0024】

通信部２２は、制御部２１が取得した点群情報等をサーバ装置１に送信する。また、通信部２２は、サーバ装置１から配信された地図データ等を受信する。

【0025】

記憶部２３は、制御部２１で動作するプログラムや各種データ等が格納されている。また、記憶部２３は、サーバ装置１から配信された地図データを記憶する。

【0026】

センサ３は、ライダ３ａと、ＧＰＳ受信機３ｂと、を備えている。なお、センサ３は、これらのセンサ以外に、例えば速度センサ等の他のセンサを備えていてもよい。さらには、車両の前方等の周囲を撮像する車載カメラをセンサ３に含めてもよい。

【0027】

ライダ３ａは、電磁波としてレーザ光を出射することで、外界に存在する物体までの距離を離散的に測定する。所定の検知領域において出力方向を変えながらパルス状のレーザを出力し、そのレーザの反射波を受信して点群情報を生成する。ライダ３ａは、検知領域内に複数パルスのレーザを出力し、この複数パルスのレーザの反射波に基づいて点群情報を生成する。点群情報を構成するそれぞれの情報は、レーザの出力方向と、当該レーザを反射した対象物までの距離と、反射波の強度（反射強度）と、を示す情報である。本実施例では、ライダ３ａは、主にレーザを路面に向けて照射し、路面を検知領域としている。このため、点群情報は、対象物としての路面までの距離を示す情報及び反射強度の情報が含まれる。勿論、路面以外にレーザを出射して、路面情報以外の周辺情報を取得するようにしてもよい。

【0028】

ＧＰＳ受信機３ｂは、公知であるように複数のＧＰＳ衛星から送信される電波を定期的に受信して、現在の位置情報及び時刻を検出する。

【0029】

次に、上述した構成のサーバ装置１（地図データ生成装置）における地図データ生成方法について図４～図７を参照して説明する。図４は、サーバ装置１で実行されるフローチャートである。このフローチャートは、サーバ装置１の制御部１１で実行される。つまり、制御部１１のＣＰＵで実行されるコンピュータプログラム（地図データ生成プログラム）として構成されている。なお、このプログラムは、記憶部１３に記憶させるに限らず、光ディスクやメモリーカード等に記憶させてもよい。

【0030】

まず、ステップＳ１１において、制御部１１は、車載装置２から点群情報等を取得する。なお、本ステップでは、車載装置２から収集した点群情報について、ＧＰＳ受信機３ｂが検出した現在位置に基づいて各点までの距離を絶対座標に変換している。あるいは、予め車載装置２で絶対座標に変換してもよい。即ち、制御部１１は、ライダ３ａ（所定のセンサ）から点群情報（路面情報）を取得する取得部として機能する。

【0031】

次に、ステップＳ１２において、制御部１１は、ステップＳ１１で取得した点群情報に基づいて二値化画像を生成する。本実施例の二値化画像とは、三次元座標を持つ点群を二次元化して、各点の反射強度に基づいて所定の閾値により二値化した画像である。このようにして生成された二値化画像は、反射強度の高い点が輝度が高いピクセルとして表現される。この二値化画像に含まれるピクセルは、変換前の点群が有する座標情報も引き継いでいる。

【0032】

即ち、制御部１１は、取得部が取得した点群情報（路面情報）に基づいて、二値化画像（当該路面に描かれた標示を示す情報）を生成する標示情報生成部として機能する。

【0033】

次に、ステップＳ１３において、制御部１１は、ステップＳ１２で生成した二値化画像から路面外の輝度が高いピクセルを除去する。除去の例を図５及び図６を参照して説明する。図５は、ある道路の点群情報に基づいて生成された二値化画像である。この二値化画像上に白線（区画線）Ｗと、右折を示す進行方向別通行区分Ｒ（以下右折矢印Ｒとする）と、直進を示す進行方向通行区分Ｓ（以下直進矢印Ｓとする）が描かれている。また、この二値化画像には、路面外の不要なピクセルＵ（路面外の輝度が高いピクセル）も含まれている場合がある。

【0034】

そして、このような二値化画像において、白線Ｗや進行方向別通行区分といった道路標示等の路面に描かれた標示以外の不要なピクセルＵを除去する。除去の方法としては、例えば、点群情報を取得した領域の地図データを別途取得し、その地図データに設定されている通行可能領域（路面の領域）と二値化画像とを対比させて、路面外にある輝度が高いピクセルを特定する方法が挙げられる。また、地図データに含まれる道路や車線のネットワークデータから道路や車線の幅員情報を取得して、路面外にある輝度が高いピクセルを特定してもよい。

【0035】

不要なピクセルＵの除去後の二値化画像を図６に示す。上述した処理によって、不要なピクセルＵが除去され、白線Ｗや右折矢印Ｒ、直進矢印Ｓといった路面に描かれた標示のみが残る。

【0036】

次に、ステップＳ１４において、制御部１１は、ステップＳ１３の処理が施された二値化画像において、路面に描かれた標示に対応するピクセルを一定サイズのセルにまとめる（セルを生成する）。生成されたセルは、当該セルに含まれるピクセルに基づいて座標情報が付与されている。即ち、標示情報生成部で生成された二値化画像（標示を示す情報）に基づいて当該標示を複数のセルで分割している。

【0037】

ここで、本実施例のセルについて図７を参照して説明する。図７は、白線Ｗと右折矢印Ｒとが描かれた路面を示している。図７では、白線Ｗ、右折矢印Ｒとも破線内がステップＳ１３において輝度が高いピクセルとして表現されている。つまり、破線内が路面上に白線Ｗや右折矢印Ｒとして描かれた領域となる。

【0038】

図７に示したように、路面に描かれた標示に対応するピクセルを一定サイズのセルＣにまとめることで、白線Ｗや右折矢印Ｒは複数のセルＣで分割される。このセルＣのサイズは路面に描かれた標示を複数に分割できる程度の大きさで適宜定めればよい。また、セルＣの形状は正方形に限らず長方形等の矩形や、三角形や六角形等の多角形でもよい。

【0039】

また、図７の例では、路面に描かれた標示が一部でも含まれる部分のみをセルにまとめているが、路面全体を複数のセルに分割したグリッド状（メッシュ状）としてもよい。但し、路面に描かれた標示のみをセルとした方が地図データのデータ量を小さくすることができる。また、路面全体を複数のセルに分割する場合は、路面に描かれた標示を含むセルには、その旨を示すフラグ等の情報を付与するとよい。

【0040】

図４の説明に戻り、ステップＳ１５において、制御部１１は、後述する統計情報の付与のためステップＳ１４で生成されたセルＣの座標からステップＳ１１で取得した点群を参照して、セルＣと点群とを対応させる。即ち、各セルＣには座標情報が位置情報（位置に関する情報）として付与されている。

【0041】

そして、ステップＳ１６において、制御部１１は、各セルＣに属性情報としての統計情報を付与する。統計情報の例としては、当該セルＣに対応する点群の反射強度の平均や分散あるいはヒストグラム等が挙げられる。このようにして統計情報が付与された複数のセルＣからなる路面に描かれた標示を地図データに含めることで地図データが生成される。即ち、制御部１１は、複数のセルＣのそれぞれに、点群情報（路面情報）に基づく当該セルＣの位置に関する情報を含めて地図データを生成する地図データ生成部として機能する。

【0042】

以上の説明から明らかなように、ステップＳ１１が取得工程、ステップＳ１２が標示情報生成工程、ステップＳ１４～Ｓ１６が地図データ生成工程として機能する。

【0043】

なお、センサ３に含まれるものとして車載カメラが車両Ｖに搭載されている場合は、各点にカメラで撮像された画像に基づく色を付加した色付き点群とし、反射強度に代えて色の平均や分散を用いてもよい。また、当該セルＣに対応する点群の座標値の平均や共分散を統計情報として付与することもできる。この場合は、反射強度又は色によるフィルタリング処理を施して路面に描かれた標示のみの点群の座標値を取り出す処理が必要となる。

【0044】

図８に、図４のフローチャートにより生成された地図データの地図データ構造の例を示す。図８に示したように、地図データ構造は、セルＩＤ１３１と、位置１３２と、統計情報１３３と、を含んでいる。セルＩＤは、セルを識別するＩＤである。位置１３２は、セルの位置を示す情報である、この位置１３２は、セルＣ毎に絶対位置（緯度、経度）を設定するに限らず、基準となるセルＣからの相対位置を設定してもよい。例えば図７の右折矢印Ｒであれば、左隅にあるセルＣを基準セルとして絶対位置を設定し、他のセルＣは基準セルからの相対位置を設定するようにしてもよい。統計情報１３３は、上述した反射強度や座標値の平均や分散等の情報が設定されている。また、図８に示した項目以外に、例えばその標示の内容を示す情報（白線、右折矢印、最高速度等）を含めてもよい。

【0045】

即ち、図８に示した地図データ構造は、路面に描かれた標示が複数のセルＣで分割されて表され、更に複数のセルＣのそれぞれには、当該セルＣの位置に関する情報（位置１３２）が設定されている。

【0046】

このような地図データ構造を有する地図データは、例えば、車載装置２がナビゲーションや自動運転等の車両Ｖを誘導（案内）する機能を有する誘導（案内）装置として機能する場合に、この地図データを参照することで、路面に描かれた標示について、白線以外の標示も認識して案内することができる。

【0047】

ところで、図４に示したフローチャートでは、路面に描かれた標示は全てセルＣで分割されるようにしているが、区画線（例えば白線）は、形状が線であり単純であるため、例えば区画線の中心線を点列として地図データに格納することで、よりデータ量を削減することが可能である。そのため、セルＣに分割する対象から区画線を除いてもよい。区画線を除いてセルＣに分割する地図データ生成方法を図９に示す。

【0048】

まず、ステップＳ２１において、制御部１１は、図４のステップＳ１１と同様に、車載装置２から点群情報等を取得する。

【0049】

次に、ステップＳ２２において、制御部１１は、図４のステップＳ１２と同様に、ステップＳ２１で取得した点群情報に基づいて二値化画像を生成する。

【0050】

次に、ステップＳ２３において、制御部１１は、二値化画像から白線（区画線）を抽出する。本ステップにおける区画線の抽出方法の例を説明する。まず、二値化画像について画像処理を行い、例えば線分（直線）等を検出する。そして、検出した線分（直線）等のグルーピングを行い、一つの区画線の輪郭を抽出する。そして、既知の手法等を用い、抽出された区画線を点列により表現する。さらに、抽出された区画線から白線の端部及び非端部を認識し、当該認識した端部及び非端部間に点列を内挿（すなわち、端部と端部の間の連続部分に点列を内挿）してもよい。

【0051】

このようにして、白線を点列により表現することができる（図１０を参照）。図１０は、図７について、白線Ｗの部分を点列で示したものである、白線Ｗは上述したステップＳ２３の処理によって、セルＣではなく複数の点Ｐにより表現される。

【0052】

図９の説明に戻る。次に、ステップＳ２４において、制御部１１は、ステップＳ２２で生成した二値化画像から路面外の輝度が高いピクセル及びステップＳ２３で抽出した白線部分のピクセルを除去する。路面外の輝度が高いピクセルについては、ステップＳ１３と同様の方法で除去すればよい。白線部分については、ステップＳ２３の処理によって抽出された輪郭に基づいて除去すればよい。

【0053】

次に、ステップＳ２５において、制御部１１は、ステップＳ２４の処理が施された二値化画像において、路面に描かれた標示に対応するピクセルを一定サイズのセルＣにまとめる（セルＣを生成する）。本ステップでは、ステップＳ２４で白線部分は除去されているので、白線を除いた路面に描かれた標示がセルＣに分割される。

【0054】

次に、ステップＳ２６において、制御部１１は、図４のステップＳ１５と同様に統計情報の付与のためステップＳ２５で生成されたセルＣの座標からステップＳ２１で取得した点群を参照してセルＣと点群とを対応させる。

【0055】

そして、ステップＳ２７において、制御部１１は、図４のステップＳ１６と同様に各セルＣに統計情報を付与する。このようにして統計情報が付与された複数のセルＣからなる路面に描かれた標示及び、ステップＳ２３で点列として表現された白線を地図データに含めることで地図データが生成される。

【0056】

次に、上述した方法により生成された地図データ構造を有する地図データを用いて車載装置２で実行される自己位置推定方法について図１１のフローチャートを参照して説明する。このフローチャートは、車載装置２の制御部２１で実行される。つまり、制御部２１のＣＰＵで実行されるコンピュータプログラム（地図データ生成プログラム）として構成されている。なお、このプログラムは、記憶部２３に記憶させるに限らず、光ディスクやメモリーカード等に記憶させてもよい。

【0057】

まず、ステップＳ３１において、制御部２１は、ライダ３ａから点群情報を取得する。この点群情報は、ライダ３ａがリアルタイムに取得した情報である。即ち、制御部２１は、車両走行によってライダ３ａ（センサ）から得られた点群情報（センサ情報）を取得するセンサ情報取得部として機能する。

【0058】

次に、ステップＳ３２において、制御部２１は、ステップＳ３１で取得した点群情報から路面に描かれた標示を、例えば地表面点群をフィルタリングする等により認識する。即ち、制御部２１は、センサ情報取得部が取得した点群情報（センサ情報）から路面に描かれた標示に該当する点群情報（センサ情報）を認識する認識部として機能する。

【0059】

次に、ステップＳ３３において、制御部２１は、記憶部２３から地図データを取得する。本ステップで取得する地図データは、図８で説明した地図データ構造を有するものである。即ち、制御部２１は、路面に描かれた標示が複数のセルＣで分割されて表されており、複数のセルＣのそれぞれには、当該セルＣの位置に関する情報が設定されている地図データ、を取得する地図データ取得部として機能する。なお、地図データはサーバ装置１か
ら直接取得するようにしてもよい。

【0060】

そして、ステップＳ３４において、制御部２１は、ステップＳ３２の処理が施された点群情報と、地図データに含まれる標示と、のマッチングを行って自己位置の推定をする。具体的には、点群情報と、地図データ側の各セルの統計情報とのマッチングを行って自己位置の推定をする。なお、マッチングの方法としては、ＮＤＴ（Normal Distributions Transform）等の周知のセルＣと点群とのマッチング方法を利用すればよい。即ち、制御部２１は、認識部により認識された標示に該当する点群情報（センサ情報）と、地図データと、のマッチングを行うことにより車両の自己位置を推定する推定部として機能する。

【0061】

なお、マッチングは、ライダ３ａからリアルタイムに取得した点群情報を地図データと同様にセルで分割して統計情報を生成した上で行ってもよい。

【0062】

以上の説明から明らかなように、ステップＳ３１がセンサ情報取得工程、ステップＳ３２が認識工程、ステップＳ３３が地図データ取得工程、ステップＳ３４が推定工程として機能する。

【0063】

また、上述した説明では、サーバ装置１で地図データを生成していたが、車載装置２で地図データの生成を行ってサーバ装置１へアップロードするようにしてもよい。つまり、図４や図９に示したフローチャートは車載装置２で実行される。この場合、サーバ装置１では、各車載装置２からアップロードされた部分的な地図データの結合や更新等の処理を行う。

【0064】

また、上述した説明では、点群等の収集を行う車両と、自己位置推定を行う車両が同じ車両Ｖであったが、異なる車両であってもよい。例えば、点群等の収集は専用の計測機器を搭載した計測車両が行い、その計測結果を利用して生成された地図データの配信を一般車両が受けて自己位置推定をするといった構成でもよい。

【0065】

また、上述した実施例では、点群を取得するのは車両に搭載されたライダ３ａであったが、車両ではなく航空機等の飛翔体にライダを搭載し、上空から地上に向けてレーザ光を照射して得られた点群について上記した二値化処理等を行って地図データを生成してもよい。

【0066】

本実施例によれば、サーバ装置１は、通信部１２がライダ３ａで検出された点群情報を取得し、制御部１１が通信部１２で取得された点群情報に基づいて、二値化画像を生成する。そして、二値化画像の路面に描かれた標示の部分を複数のセルＣで分割し、複数のセルＣのそれぞれに、位置１３２及び統計情報１３３を含めて地図データを生成する。このようにすることにより、路面に描かれた標示を地図データに含めることができ、車両Ｖの自己位置推定の精度を向上させることができる。また、複数のセルＣによって路面に描かれた標示を表現するため、複雑な形状の標示について、その輪郭を抽出して図化するといった複雑な処理を必要とせず、また、輪郭を再現する必要が無いので情報量を少なくすることが可能となる。

【0067】

また、制御部１１は、点群情報に基づいて統計情報１３３をセルＣ毎に設定しているので、例えば、セルＣ内における点群の分散や反射強度を統計情報として有するようにすれば、そのセルＣにおける標示を示すペイントの分布や割合等を把握することが可能となる、つまり、標示の輪郭が含まれるセルＣを特定することができる。

【0068】

また、路面に描かれた標示は、区画線を除く標示であってもよい。このようにすることにより、白線等の区画線を除く、右折や左折等を示す進行方向別通行区分や最高速度といった道路標示について地図データに含めることが可能となる。

【0069】

また、本実施例にかかる地図データ構造は、路面に描かれた標示が複数のセルＣで分割されて表され、更に複数のセルＣのそれぞれには、当該セルＣの位置１３２が設定されており、この地図データ構造を利用する車載装置２は、セルＣの位置１３２によって、路面に描かれた標示を認識して車両Ｖの自己位置推定処理を行う。このようにすることにより、路面に描かれた標示を地図データに含めることができ、車両Ｖの自己位置推定の精度を向上させることができる。また、複数のセルＣによって標示を表現するため、複雑な形状の標示について、その輪郭を抽出して図化するといった複雑な処理を必要とせず、また、輪郭を再現する必要が無いので情報量を少なくすることが可能となる。

【0070】

また、地図データ構造は、セルＣ毎に当該セルＣについての統計情報を有していている。このようにすることにより、セルＣ内における点群の座標や反射強度の分散等を統計情報として格納することで、そのセルＣにおける標示を示すペイントの分布や割合等を把握することが可能となる、つまり、標示の輪郭が含まれるセルを特定することができる。

【0071】

また、サーバ装置１は、上述した地図データ構造を有する地図データが格納されているので、サーバ装置１から複数の車両に地図データを配信等することができる。

【0072】

また、車載装置２は、路面に描かれた標示が複数のセルＣで分割されて表されており、複数のセルＣのそれぞれには、当該セルＣの位置１３２が設定されている地図データを、制御部２１が取得し、車両走行によってライダ３ａから得られた点群情報を取得する。そして、制御部２１が取得した点群情報から路面に描かれた標示に該当する点群情報を認識し、認識された路面に描かれた標示に該当する点群情報と、地図データと、のマッチングを行うことにより車両の自己位置を推定する。このようにすることにより、路面に描かれた標示を利用して自己位置推定をすることができ、車両Ｖの自己位置推定の精度を向上させることができる。

【実施例0073】

次に、本発明の第２の実施例にかかる地図データ生成装置を図１２～図１３を参照して説明する。なお、前述した第１の実施例と同一部分には、同一符号を付して説明を省略する。

【0074】

本実施例は、構成は図１と同様であるが、地図データ生成方法が異なる。図１２に本実施例にかかる地図データ生成方法のフローチャートを示す。このフローチャートは、サーバ装置１の制御部１１で実行される。

【0075】

まず、ステップＳ４１において、制御部１１は、車載装置２から点群情報等を取得する。

【0076】

次に、ステップＳ４２において、制御部１１は、ステップＳ４１で取得した点群について、各々が有する反射強度情報及び高さ情報（距離情報）に基づいてフィルタリングする。反射強度情報によるフィルタリングにより、再帰性反射材が用いられた反射強度が高い道路標示等の路面に描かれた標示を抽出することができる。また、高さ情報によるフィルタリングにより、標識等の路面以外の反射強度が高い点を排除することができる。

【0077】

次に、ステップＳ４３において、ステップＳ４２の処理が施された点群情報に対して、ステップＳ１４等と同様に一定サイズのセルＣにまとめる（セルＣを生成する）。このステップの時点で各セルＣには点群情報の各点が有する絶対座標に基づいて位置情報が付与されている。

【0078】

そして、ステップＳ４４において、制御部１１は、ステップＳ１６等と同様に、各セルＣに属性情報としての統計情報を付与する。このようにして統計情報が付与された複数のセルＣからなる路面に描かれた標示を地図データに含めることで地図データが生成される。

【0079】

ここで、本実施例も第１の実施例と同様に、セルＣに分割する対象から区画線を除いてもよい。区画線を除いてセルＣに分割する地図データ生成方法を図１３に示す。

【0080】

まず、ステップＳ５１において、制御部１１は、上述したステップＳ２１と同様に、車載装置２から点群情報等を取得する。

【0081】

次に、ステップＳ５２において、制御部１１は、上述したステップＳ２２と同様に、ステップＳ５１で取得した点群情報に基づいて二値化画像を生成する。

【0082】

次に、ステップＳ５３において、制御部１１は、二値化画像から白線（区画線）を抽出する。

【0083】

次に、ステップＳ５４において、制御部１１は、ステップＳ５１で取得した点群情報から白線に対応する点群をフィルタリングする。また、制御部１１は、ステップＳ４２と同様に、各々が有する反射強度情報及び高さ情報（距離情報）に基づいてフィルタリングする。

【0084】

次に、ステップＳ５５において、制御部１１は、ステップＳ５４の処理が施された点群情報に対して、ステップＳ４３と同様に一定サイズのセルＣにまとめる（セルＣを生成する）。

【0085】

次に、ステップＳ５６において、制御部１１は、ステップＳ４４と同様に、各セルＣに属性情報としての統計情報を付与する。このようにして統計情報が付与された複数のセルＣからなる路面に描かれた標示及び、ステップＳ５３で点列として表現された白線を地図データに含めることで地図データが生成される。

【0086】

本実施例によれば、サーバ装置１は、通信部１２がライダ３ａで検出された点群情報を取得し、制御部１１が通信部１２で取得された点群情報に基づいて、フィルタリングをする。そして、フィルタリングされた点群における路面に描かれた標示の部分を複数のセルＣで分割し、複数のセルＣのそれぞれに、位置１３２及び統計情報１３３を含めて地図データを生成する。このようにすることにより、点群情報から直接路面に描かれた標示をセル化することができる。

【0087】

なお、上述した２つの実施例では、セルＣは平面状のものであったが、ボクセルや柱体など、立体で分割してもよい。

【0088】

また、本発明は上記実施例に限定されるものではない。即ち、当業者は、従来公知の知見に従い、本発明の骨子を逸脱しない範囲で種々変形して実施することができる。かかる変形によってもなお本発明の地図データ生成装置、地図データ構造及び自己位置推定装置を具備する限り、勿論、本発明の範疇に含まれるものである。