(57)【要約】【課題】高価な機器を用いずに、高精度な位置推定を実現すること。【解決手段】自動運転車１は、カメラ２２と、もう１つのカメラとを備える。２つのカメラは、ステレオカメラを構成し、前方の路面の各位置までの距離を測定するために用いられる。路面までの距離を測定することによって、カメラ座標系を基準とした路面の近似式が求まる。この近似式から、自動運転車１の姿勢を推定できる。３次元地図データ上に、推定した姿勢によって、仮想的にステレオカメラを配置し、仮想的に配置されたステレオカメラによって取得される距離データを求める。撮像によって作成した距離データと、３次元地図データに基づき作成された距離データとをマッチングさせることで、位置を推定する。【選択図】図６
2018194417.tif 000002
【特許請求の範囲】
【請求項１】
路面上を移動する機能と、路面を含む周辺の物標までの距離値を取得するための測距装置（２１，２２）とを有する移動装置（１，２）の位置を推定する位置推定装置（１０，１０ａ）であって、
周辺の路面に対する前記移動装置の姿勢を、前記移動装置周辺の路面までの距離値の集合である距離データに基づき決定する姿勢決定部（Ｓ２００）と、
前記姿勢決定部によって決定された姿勢を用いて、３次元地図データによって定義される空間に仮想的に配置された前記測距装置による測定を模擬することによって得られる距離値の集合である距離データを、複数の候補位置それぞれについて算出する算出部（Ｓ３１０，Ｓ３２０）と、
前記複数の候補位置の中から前記移動装置の位置として尤もらしいものを、前記測距装置による測定結果と、前記算出部による算出結果とのマッチングに基づき選択する選択部（Ｓ４００）と、
を備える位置推定装置。
【請求項２】
前記移動装置は、周辺の物標の輝度値を測定するための撮像装置（２１，２２）を有し、
前記３次元地図データには、３次元位置の輝度値が格納されており、
前記姿勢決定部によって決定された姿勢を用いて、３次元地図データ上に仮想的に配置された前記撮像装置による撮像を模擬することによって得られる輝度値を、前記複数の候補位置それぞれについて取得する取得部（Ｓ３１０，Ｓ３３０）を更に備え、
前記選択部は、前記選択を、前記撮像装置による測定結果と、前記取得部による取得結果とのマッチングを加味して実行する
請求項１に記載の位置推定装置。
【請求項３】
前記取得部によって取得された輝度値、及び前記撮像装置によって測定された輝度値の中から、前記マッチングに使用しない領域に属する値を除去する輝度値除去部（Ｓ３５０）を備える
請求項２に記載の位置推定装置。
【請求項４】
前記輝度値除去部は、路面を基準に、第１輝度用高さから第２輝度用高さまでの領域を対象に、前記除去を実行する
請求項３に記載の位置推定装置。
【請求項５】
前記測距装置による測定された距離値、及び前記算出部によって算出された距離値の中から、前記マッチングに使用しない領域に属する値を除去する距離値除去部（Ｓ３４０，Ｓ３６０）を備える
請求項１から請求項４までの何れか一項に記載の位置推定装置。
【請求項６】
前記距離値除去部（Ｓ３４０）は、路面を基準に、第１距離用高さから第２距離用高さまでの領域を対象に、前記除去を実行する
請求項５に記載の位置推定装置。
【請求項７】
前記距離値除去部（Ｓ３６０）は、予め定められた高さ以上の領域を対象に、前記除去を実行する
請求項５から請求項６までの何れか一項に記載の位置推定装置。
【請求項８】
前記姿勢決定部は、所定方向を代表する値を定めることによって前記測距装置の測定による距離データを２次元化し、前記測距装置に対する路面の相対位置を前記２次元化した距離データに基づき決定することによって前記姿勢を決定する
請求項１から請求項７までの何れか一項に記載の位置推定装置。
【請求項９】
前記測距装置は、ステレオカメラとして構成された撮像装置であり、
前記所定方向は、撮像における水平方向であり、
前記姿勢決定部は、前記移動装置のピッチ角と前記撮像装置の路面からの高さとを、前記姿勢として決定する
請求項８に記載の位置推定装置。
【請求項１０】
前記姿勢決定部は、前記路面の相対位置の決定に失敗した場合、過去に決定した位置を用いて、前記姿勢の決定を実行する
請求項８から請求項９までの何れか一項に記載の位置推定装置。
【請求項１１】
前記移動装置は、自動運転車（１）である
請求項１から請求項１０までの何れか一項に記載の位置推定装置。
【請求項１２】
請求項１から請求項１１までの何れか一項に記載の移動装置（１）であって、
請求項１から請求項１１までの何れか一項に記載の位置推定装置（１０）を備える
移動装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本開示は、位置推定に関する。
【背景技術】
【０００２】
特許文献１は、車載カメラを利用した実時間測位の技術について開示している。この技術では、実画像の領域から、直線や角点などの特徴部を抽出し、地図データとマッチングさせることによって、自車の位置を測定している。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２０１２−１８５０１１号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
上記先行技術の場合、マッチングに用いられる物理量が輝度値のみであるため、測定精度が低い。高精度な測位が可能な技術としては、例えばＲＴＫ−ＧＰＳが知られているものの、受信機が高価である。本開示は、上記を踏まえ、高価な機器を用いずに、高精度な位置推定を実現することを解決課題とする。
【課題を解決するための手段】
【０００５】
本開示の一形態は、路面上を移動する機能と、路面を含む周辺の物標までの距離値を取得するための測距装置（２１，２２）とを有する移動装置（１，２）の位置を推定する位置推定装置（１０，１０ａ）であって；周辺の路面に対する前記移動装置の姿勢を、前記移動装置周辺の路面までの距離値の集合である距離データに基づき決定する姿勢決定部（Ｓ２００）と；前記姿勢決定部によって決定された姿勢を用いて、３次元地図データによって定義される空間に仮想的に配置された前記測距装置による測定を模擬することによって得られる距離値の集合である距離データを、複数の候補位置それぞれについて算出する算出部（Ｓ３１０，Ｓ３２０）と；前記複数の候補位置の中から前記移動装置の位置として尤もらしいものを、前記測距装置による測定結果と、前記算出部による算出結果とのマッチングに基づき選択する選択部（Ｓ４００）と；を備える位置推定装置である。この形態によれば、通常の測距装置を用いることで、高精度な位置推定が可能になる。
【図面の簡単な説明】
【０００６】
【図１】自動運転車のブロック構成図。
【図２】位置推定処理を示すフローチャート。
【図３】姿勢決定処理を示すフローチャート。
【図４】撮像画像の一例。
【図５】各ｙ値に沿った距離値を示すグラフ。
【図６】基準状態の場合の路面におけるｙ値と距離値との関係を示すグラフ。
【図７】ピッチングした場合の路面におけるｙ値と距離値との関係を示すグラフ。
【図８】マッチングの準備処理を示すフローチャート。
【図９】低位領域の値が除去された様子を示す図。
【図１０】高位領域の距離値が除去された様子を示す図。
【図１１】位置推定装置と、複数の自動運転車とが通信する様子を示す図。
【図１２】実施形態２の自動運転車のブロック構成図。
【発明を実施するための形態】
【０００７】
実施形態１を説明する。図１に示す自動運転車１は、レベル１以上の自動運転車である。具体的には、自動運転車１は、少なくとも操舵を自動で実施できる機能を有している。
【０００８】
自動運転車１は、ＥＣＵ１０を搭載する。ＥＣＵ１０は、カメラＥＣＵである。ＥＣＵ１０は、カメラ２１とカメラ２２とから撮像データとして各ピクセルのＲＧＢ値を取得し、後述する位置推定処理を実行する。
【０００９】
カメラ２１，２２は、自動運転車１の前方が撮像範囲内となるように搭載されている。カメラ２１，２２は、各ピクセルの輝度値を取得し、ＥＣＵ１０に入力する。カメラ２１，２２は、視差を利用した距離測定のために、車幅方向に並んで配置されたステレオカメラを構成している。ＥＣＵ１０は、カメラ２１，２２の焦点距離、及び基線長を用いることで、撮像された各ピクセルについて距離値を取得することができる。距離値とは、カメラ２１，２２から、撮像された物体までの距離を示す値のことである。
【００１０】
図１に示すように、自動運転車１は、ヨーレートセンサ３０と、車速センサ４０と、ＧＮＳＳ受信機５０と、地図データ記憶装置６０とを備える。ヨーレートセンサ３０は、自動運転車１のヨーレートを計測して、ＥＣＵ１０に入力する。車速センサ４０は、自動運転車１の車速を計測して、ＥＣＵ１０に入力する。
【００１１】
ＧＮＳＳ受信機５０は、ＧＮＳＳ測量を実施するために航法信号を受信する。ＧＮＳＳは、Global Navigation Satellite Systemの頭字語であり、全地球航法衛星システムのことである。
【００１２】
地図データ記憶装置６０は、３次元地図データを記憶している。ここでいう３次元地図データは、３次元の各格子点に対して物標の有無が対応付けられており、物標が有りと対応付けられた格子点には、さらに輝度値が対応付けられたデータ構造を有している。３次元の各格子点の位置は、緯度、経度、標高の各値によって定義されている。
【００１３】
ここでいう物標とは、レーダや画像等によるデータ収集によって、何かしらの物体が有ると認められた全ての物体のことを意味する。物標には、路面が含まれる。本実施形態では位置推定の対象が自動運転車１であるので、ここでいう路面は、車道の表面である。輝度値のデータは、概ね昼間に撮像された撮像データに基づき、３次元地図データに格納する値が決定されている。
【００１４】
地図データ記憶装置６０は、ＧＮＳＳ受信機５０から入力される信号を利用して、３次元地図データから一部のデータを抜粋し、ＥＣＵ１０に入力する。
【００１５】
ＥＣＵ１０は、カメラ２１，２２による撮像データ、ヨーレート、車速、３次元地図データを用いて、図２に示す位置推定処理を実行するによって、自動運転車１の位置を推定する。このため、本実施形態における位置推定処理は、自己位置推定処理である。
【００１６】
ＥＣＵ１０は、位置推定処理を、自動運転機能がオンに設定されている間、繰り返し実行する。ＥＣＵ１０は、推定した位置を、自動運転を制御するＥＣＵに入力する。なお、自動運転を制御するＥＣＵは、図示されていない。
【００１７】
図２に示すように、ＥＣＵ１０は、位置推定処理を開始すると、Ｓ１００として、撮像データから、距離データと輝度データとを取得する。距離データとは、各ピクセルに距離値が対応付けられた構造を有するデータのことである。輝度データとは、各ピクセルに輝度値が対応付けられた構造を有するデータのことである。
【００１８】
続いて、ＥＣＵ１０は、Ｓ２００として姿勢決定処理を実行する。ＥＣＵ１０は、姿勢決定処理を開始すると、Ｓ２１０として、路面の推定を実行する。以下、図４に示された撮像画像を例にとって、Ｓ２１０を説明する。図４に示すように、撮像範囲の水平方向をｘ方向、垂直方向をｙ方向と定義する。
【００１９】
Ｓ２１０は、距離データを元に、路面を表す式を決定するステップである。ここで決定される式は、カメラ座標系との変換関係が既知である座標系において定義される。このため、Ｓ２１０は、カメラ座標系において定義される路面の式を求めていることと等価である。
【００２０】
図４に示すように、ｙ０〜ｙ８に沿って取得された距離値を抜粋して説明に用いる。ｙ０は撮像範囲の下辺に相当する値であり、ｙ８は撮像範囲の上辺に相当する値である。
【００２１】
図５は、縦軸を距離値ｚ、横軸を水平方向ｘにしたグラフに、ｙ０〜ｙ８それぞれの場合について距離値をプロットした様子を示す。ｙ７については、空と、遠方に位置する高層ビルとを対象にしており、図５に示されたｚ軸の範囲外であるため、図５に示されていない。ｙ８についても、空を対象にしており、図５に示されたｚ軸の範囲外であるため、図５に示されていない。
【００２２】
図６は、基準状態の場合に、ｙ値と距離値ｚとの関係を、或るｘ値について示すグラフである。基準状態とは、自動運転車１が全くピッチングやローリングをしておらず、且つ、水平な路面上を走行または停止している状態のことである。
【００２３】
路面が水平に限らず平坦であれば、図６に示すように、ｙ値と距離値ｚとの関係は、直線になる。一方、前方に坂があることによって、路面が平坦でない場合については、ｙ値と距離値ｚとの関係は、曲線で近似される。以下、ｙ値と距離値ｚとの関係において曲線といえば、直線を含むものとする。
【００２４】
路面に該当する領域内であれば、各ｘ値について同様な関係を得ることができる。従って、距離データを用いることによって、カメラ２１，２２を基準とした座標系における路面を近似する面の方程式を得ることができる。
【００２５】
但し、本実施形態では、幅方向については、路面は平坦であると仮定する。幅方向とは、路面上に沿った方向であって、車線によって規定される進行方向と直交する方向のことである。このように仮定すれば、路面を２次元空間における曲線で表すことができる。そこで本実施形態においては、各ｙ値について、距離値ｚの代表値を定め、１つの近似曲線を求める。本実施形態における代表値は、最頻値によって決定する。
【００２６】
なお、幅方向およびｘ方向は、常に平行である訳ではない。例えば、自動運転車１が実際に走行している方向と、路面の進行方向とにずれがある場合や、自動運転車１がローリングしている場合には、ｘ方向は、幅方向に対して平行でなくなる。このようなずれを考慮して補正をしたり、３次元空間における曲線を求めたりしてもよいのだが、本実施形態では演算負荷の軽減のため、このようなずれを無視して、２次元空間における曲線を求める。
【００２７】
また、図４，図５に示す例の場合、ｙ４〜ｙ８の領域については、路面が含まれていない。このため、ｙ４〜ｙ８の領域については、路面の推定に用いない方がよい。但し、ｙ４〜ｙ８の領域を含めたとしても、路面の推定結果に大きな影響は無いことが多いので、本実施形態では、全ｙ値を演算の対象にして路面を推定する。なお、ｙ４〜ｙ８の領域におけるｙ値と距離値ｚとの関係は、ｙ０〜ｙ４の領域におけるｙ値と距離値ｚとの関係から大きく変化するので、両者を切り分けることは可能である。そこで、他の実施形態においては、ｙ値が小さい領域と比較して、ｙ値と距離値ｚとの関係が大きく変化した領域を除外した上で、路面を表す曲線を求める。
【００２８】
次に、ＥＣＵ１０は、Ｓ２２０として、カメラ２１，２２の高さｈとピッチ角θとを算出する。図６に示すように、本実施形態では、ｙ値がｙ３となる視線を基準とし、この視線と路面とがなす角度をピッチ角と定義する。基準状態において、ｙ値がｙ３である場合の距離値ｚは既知であり、図６には距離値ｚ３として示されている。基準状態における高さｈも、予め測定されているので既知である。
【００２９】
上記の既知の値、並びにｙ値および距離値ｚの近似式を用いることによって、高さｈ及びピッチ角θが求まる。なお、本実施形態における高さは、路面と直交する方向に沿った距離のことである。従って、坂を走行中の場合などにおいては、高さの方向は、鉛直方向と異なる。
【００３０】
最後に、Ｓ２３０として、ロール角を推定する。ロール角の推定には、距離データを用いる。Ｓ２３０には、予め学習した関係を用いる。予め学習した関係とは、ローリングが発生している多数の場合について、距離値の分布がどのような特徴を有するのかを調べることによって得られる関係である。
【００３１】
ＥＣＵ１０は、姿勢決定処理を終えると、Ｓ３００として、マッチングの準備処理を実行する。図８に示すように、ＥＣＵ１０は、まず、Ｓ３１０として、候補位置を決定する。候補位置とは、自動運転車１の現在位置の候補となる複数の位置のことである。本実施形態において、自動運転車１の位置という場合、緯度および経度に加え、ヨー角が含まれる。ヨー角は、自動運転車１の前方がどの方角を向いているかを示す角度のことである。
【００３２】
図７には、候補位置として、候補位置ｔａ，ｔｂの２つが示されている。実際には、もっと多い数の候補位置が決定される。候補位置の決定は、前回の位置推定処理において推定した推定位置ｔ−１、車速およびヨーレートを考慮して、或る程度の範囲に絞り込んだ上で、ランダムに実行される。
【００３３】
次に、ＥＣＵ１０は、Ｓ３２０として、決定した候補位置それぞれに対応する距離データを作成する。Ｓ３２０には、地図データ記憶装置６０に記憶された３次元地図データを用いる。具体的には、或る候補位置に対応する距離データを作成する場合、３次元地図データ上において、カメラ２１，２２をその候補位置に仮想的に配置する。この仮想的な配置には、姿勢決定処理によって決定した姿勢を適用する。そして、仮想的に配置されたカメラ２１，２２による撮像を模擬して、距離データを３次元地図データから作成する。
【００３４】
次に、ＥＣＵ１０は、Ｓ３３０として、決定した候補位置それぞれに対応する輝度データを作成する。Ｓ３３０は、距離値と輝度値との違いを除けば、Ｓ３２０と同様な内容である。
【００３５】
次に、ＥＣＵ１０は、Ｓ３４０として、距離データから、低位領域に属する値を除去する。Ｓ３４０において対象にするデータは、Ｓ１００としての撮像によって作成されたデータと、Ｓ３２０によって作成された距離データとである。低位領域とは、所定の高さよりも低い領域のことである。但し、路面を示す距離値が除去されないように、路面すれすれよりも低い領域は、低位領域から除外されている。
【００３６】
次に、ＥＣＵ１０は、Ｓ３５０として、輝度データから、低位領域に属する値を除去する。Ｓ３４０において対象にするデータは、Ｓ１００としての撮像によって作成されたデータと、Ｓ３３０によって作成された輝度データとである。低位領域の定義は、Ｓ３４０の説明で述べた通りである。
【００３７】
図９に示すように、低位領域が除去されることによって、前方車や歩行者に対応する値が除去される。このように、低位領域を除去する目的は、撮像によって作成されるデータには含まれる一方、３次元地図データには含まれない物標を、マッチングの対象から除外することである。このため、本実施形態においては、低位領域の基準となる所定の高さは、路面上や路面付近を移動する物標が除外されるように定められている。具体的には、トラック等の大型自動車の車高よりも少し高い程度に定められている。
【００３８】
最後に、ＥＣＵ１０は、Ｓ３６０として、距離データから、高位領域に属する値を除去する。Ｓ３６０において対象にするデータは、Ｓ３４０と同様、Ｓ１００としての撮像によって作成された距離データと、Ｓ３２０によって作成された距離データとである。高位領域とは、鉛直方向について、所定の高さよりも高い領域のことである。ここでいう所定の高さは、低位領域についての所定の高さよりも高い。
【００３９】
図１０に示すように、高位領域が除去されることによって、遠方に位置する物標の値が除去される。なお、図９と図１０とを見比べた場合に、遠方に位置する高層ビルのみが除去されたように見えるが、実際には、空に対応する領域についても、高位領域に属するので、距離データから除去される。
【００４０】
距離データから高位領域に属する値を除去する目的は、測定精度が低い距離値を除去することである。空を対象に距離を測定しても、測定自体が難しい。空でなくても、遠すぎる物標は、視差の値が小さいので、高精度な測定は難しい。このため、マッチングの対象からは、遠すぎる領域を除外することが好ましい。但し、遠すぎるか否かを距離値で判定しようとすると、距離値そのものの精度が低いので、その判定自体の精度が低くなる可能性がある。そこで、本実施形態においては、高さを基準に用いる。これは、撮像される範囲において、或る程度、高い領域は、遠い領域であると推定できることを利用している。
【００４１】
なお、輝度データについては、距離データにとっては遠すぎる領域であっても、さほど精度に影響が出る訳ではないので、除去の対象としない。例えば、図９に示される遠方の高層ビルは、輝度データについてのマッチングの対象として、十分な精度を得ることができる。
【００４２】
ＥＣＵ１０は、マッチングの準備処理を終えると、Ｓ４００としてマッチングを実行する。つまり、輝度データ及び距離データそれぞれの一致度に基づき、候補位置の中から、現在位置として最も尤もらしいものを選択する。
【００４３】
Ｓ４００は、コスト計算に基づき実施される。具体的には、距離データ、輝度データそれぞれについて差分を算出し、差分が小さいほど尤もらしいと判断する。なお、撮像データに基づき作成される輝度データは、時間帯や気象状態などに大きく依存するため、輝度値そのものではなく輝度値の勾配（エッジともいう）を、差分の算出の対象にする。
【００４４】
本実施形態においては、さらに、候補位置とオドメトリによる位置との差分も、コスト計算に加味する。オドメトリとは、車速およびヨーレートから位置を推定する手法のことである。
【００４５】
続いて、ＥＣＵ１０は、Ｓ５００として、フィルタリングを実行する。Ｓ５００には、時系列で尤もらしい自己位置を推定するために、パーティクルフィルタを用いる。
【００４６】
最後に、ＥＣＵ１０は、Ｓ６００として、上記したステップによる結果から、自己位置を推定する。
【００４７】
以上に説明した実施形態によれば、特に高価な機器を用いることなく、高精度な自己位置推定が実現できる。高精度な推定が実現される主な理由としては、路面に対する姿勢を決定してマッチングに利用している点、距離データ及び輝度データという２種類のデータをマッチングの対象にしている点、距離データから低位領域および高位領域を除去している点、輝度データから低位領域を除去している点が挙げられる。
【００４８】
さらに、本実施形態によれば、位置推定処理のための処理負荷が軽減される。位置推定処理は、自動運転に利用されるため、短い周期で繰り返される処理である。このため、処理負荷が軽いことは、重要な効果である。処理負荷が軽減される主な理由は、路面の推定において、路面を２次元化している点である。
【００４９】
路面を２次元化することは、方程式における独立変数を減らすことができることに加え、本実施形態の手法によれば、次の利点もある。その利点とは、ｘ方向あるいは幅方向について、どこからどこまでが路面であるのかを特定する必要がなくなるという点である。このため、路面の２次元化は、処理負荷の軽減に大きく貢献する。
【００５０】
しかも、路面の２次元化をしても、路面の推定精度はさほど悪化しない。なぜなら、路面は、４輪自動車によって走行しやすいように幅方向について概ね平坦に造られていることが多いため、幅方向について情報を圧縮しても、実質的な情報としては殆ど同じだからである。本実施形態では、ｘ方向に沿って最頻値を取っており、厳密には幅方向についての圧縮とは異なるものの、ｘ方向に沿って情報を圧縮しても、実用上、問題のない精度で推定ができる。
【００５１】
実施形態２を説明する。実施形態２の説明は、実施形態１と異なる点を主な対象にする。特に説明しない点については実施形態１と同じである。
【００５２】
実施形態２では、位置推定装置１０ａと複数の自動運転車２とによって、位置推定システムが構成される。
【００５３】
複数の自動運転車２それぞれは、位置推定装置を搭載しておらず、その代わりに、図１１に示すように位置推定装置１０ａと通信する。位置推定装置１０ａは、処理部１２と、地図データ記憶装置６０と、通信インタフェース７０とを備える。
【００５４】
図１２に示すように、自動運転車２は、ＥＣＵ８０を備える。ＥＣＵ８０は、カメラ２１，２２、車速センサ４０、ＧＮＳＳ受信機５０から取得した情報を、通信インタフェース９０を介して、位置推定装置１０ａに送信する。
【００５５】
処理部１２は、通信インタフェース７０を介して、自動運転車２から情報を取得する。処理部１２は、自動運転車２から取得した情報と、地図データ記憶装置６０の記憶された情報とを用い、実施形態１で説明した位置推定処理を実行する。処理部１２は、位置推定処理によって推定した位置情報を、自動運転車２に送信する。
【００５６】
ＥＣＵ８０は、通信インタフェース９０を介して位置推定装置１０ａから取得した位置情報を、自動操舵に利用する。
【００５７】
実施形態と、特許請求の範囲との対応を説明する。自動運転車１，２は移動装置に、ＥＣＵ１０，１０ａは位置推定装置に、カメラ２１は測距装置および撮像装置に、カメラ２２は測距装置および撮像装置に、Ｓ２００は姿勢決定部に、Ｓ３１０，Ｓ３２０は算出部に、Ｓ３１０，Ｓ３３０は取得部に、Ｓ３４０，Ｓ３６０は距離値除去部に、Ｓ３５０は輝度値除去部に、Ｓ４００は選択部に対応する。路面すれすれの高さは、第１輝度用高さ及び第１距離用高さに対応する。低位領域についての所定の高さは、第２輝度用高さ及び第２距離用高さに対応する。高位領域についての所定の高さは、予め定められた高さに対応する。
【００５８】
本開示は、本明細書の実施形態や実施例、変形例に限られるものではなく、その趣旨を逸脱しない範囲において種々の構成で実現できる。例えば、発明の概要の欄に記載した各形態中の技術的特徴に対応する実施形態、実施例、変形例中の技術的特徴は、先述の課題の一部又は全部を解決するために、或いは、先述の効果の一部又は全部を達成するために、適宜、差し替えや、組み合わせができる。その技術的特徴が本明細書中に必須なものとして説明されていなければ、適宜、削除できる。例えば、以下のものが例示される。
【００５９】
姿勢決定処理における路面の推定に失敗した場合、直近に推定した路面を、現在の路面として取り扱ってもよい。
【００６０】
位置推定装置の推定対象となるのは、自動車に限られず、路面を移動する移動装置であればよい。例えば、他の輸送用機器（例えば、二輪車）でもよいし、ロボットでもよい。ロボットの場合、例えば、自動車のように車輪で路面に接地してもよいし、２足歩行するタイプでもよい。
【００６１】
測距装置は、ステレオカメラでなくてもよい。例えば、ＬＩＤＡＲやミリ波レーダを用いてもよい。ＬＩＤＡＲは、Light Detection And Ranging又はLaser Imaging Detection And Rangingの頭字語である。
【００６２】
輝度値をマッチングに用いなくてもよい。この場合、３次元地図データにおいても、輝度値のデータは不要になる。
【００６３】
路面を推定するための前提条件は、適宜、変更してもよい。例えば、路面を、３次元空間における曲面として求めてもよい。
【００６４】
ロール角の推定には、輝度データを用いてもよい。輝度データを用いる場合でも、距離データを用いる場合と同様、予め学習した関係を用いてもよい。
【００６５】
上記実施形態において、ソフトウエアによって実現された機能及び処理の一部又は全部は、ハードウエアによって実現されてもよい。また、ハードウエアによって実現された機能及び処理の一部又は全部は、ソフトウエアによって実現されてもよい。ハードウエアとしては、例えば、集積回路、ディスクリート回路、または、それらの回路を組み合わせた回路モジュールなど、各種回路を用いてもよい。
【符号の説明】
【００６６】
１  自動運転車、２  自動運転車、１０  ＥＣＵ、１０ａ  ＥＣＵ、２１  カメラ、２２  カメラ
【図１】
2018194417.tif 000003
【図２】
2018194417.tif 000004
【図３】
2018194417.tif 000005
【図４】
2018194417.tif 000006
【図５】
2018194417.tif 000007
【図６】
2018194417.tif 000008
【図７】
2018194417.tif 000009
【図８】
2018194417.tif 000010
【図９】
2018194417.tif 000011
【図１０】
2018194417.tif 000012
【図１１】
2018194417.tif 000013
【図１２】
2018194417.tif 000014