JP2023076673A - 情報処理装置、制御方法、プログラム及び記憶媒体 - Google Patents

Abstract

【課題】移動体に取り付けられた計測装置が計測した計測情報を送信する際に好適な送信データの授受を行う情報処理装置を提供する【解決手段】アップロード情報Ｉｕのデータ構造は、車両に取り付けられたライダ２が計測した物体を示す計測値［ｘｉ、ｙｉ、ｚｉ］Ｔと、ライダ２が物体を計測した際の、ライダ２の車両への基準取付姿勢に対する車両への取付姿勢の変化量であるライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔとを有する。そして、このアップロード情報Ｉｕは、ライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔに基づき、計測値［ｘｉ、ｙｉ、ｚｉ］Ｔの座標系をワールド座標系に変換するサーバ装置６に送信される。【選択図】図６

Description

本発明は、計測装置の取り付け位置及び姿勢に関する情報を活用する技術に関する。

従来から、レーダやカメラなどの計測装置の計測データに基づいて、自車位置推定などを行う技術が知られている。例えば、特許文献１には、計測センサの出力と、予め地図上に登録された地物の位置情報とを照合させることで自己位置を推定する技術が開示されている。また、特許文献２には、カルマンフィルタを用いた自車位置推定技術が開示されている。

特開２０１３－２５７７４２号公報 特開２０１７－７２４２２号公報

計測装置から得られるデータは、計測装置を基準とした座標系の値であり、車両に対する計測装置の姿勢等に依存したデータとなっているため、車両を基準とした座標系の値に変換する必要がある。従って、計測装置の位置や姿勢にずれが生じた場合には、そのずれを的確に検知して計測装置のデータに反映させる必要がある。

本発明は、上記のような課題を解決するためになされたものであり、移動体に取り付けられた計測装置が計測した計測情報を送信する際に好適な送信データのデータ構造並びに当該送信データの授受を行う端末装置及びサーバ装置を提供することを主な目的とする。

請求項に記載の発明は、
移動体に取り付けられた計測装置が計測した前記移動体周辺の計測情報と、前記計測装置が前記計測情報を計測した際の前記移動体の位置推定精度に関する情報と、を取得する取得部と、
前記位置推定精度に関する情報に基づき、前記計測情報を用いた地図更新を行う更新部と、
を有する情報処理装置である。

また、請求項に記載の発明は、
情報処理装置が実行する制御方法であって、
移動体に取り付けられた計測装置が計測した前記移動体周辺の計測情報と、前記計測装置が前記計測情報を計測した際の前記移動体の位置推定精度に関する情報と、を取得する取得工程と、
前記位置推定精度に関する情報に基づき、前記計測情報を用いた地図更新を行う更新工程と、
を有する制御方法である。

また、請求項に記載の発明は、
コンピュータが実行するプログラムであって、
移動体に取り付けられた計測装置が計測した前記移動体周辺の計測情報と、前記計測装置が前記計測情報を計測した際の前記移動体の位置推定精度に関する情報と、を取得する取得部と、
前記位置推定精度に関する情報に基づき、前記計測情報を用いた地図更新を行う更新部

として前記コンピュータを機能させるプログラムである。

地図更新システムの概略構成図である。 車載機及びサーバ装置の機能的構成を示すブロック図である。 ２次元座標により表された車両座標系とライダ座標系との関係を示す図である。 ３次元座標により表された車両座標系とライダ座標系との関係を示す図である。 ２次元座標により表された車両座標系とワールド座標系との関係を示す図である。 アップロード情報のデータ構造を示す。 アップロード処理のフローチャートである。 地図更新処理のフローチャートである。

好適な実施形態によれば、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報と、を有する送信データのデータ構造であって、前記座標系情報に基づき前記位置情報の座標変換を行う情報処理装置に送信される送信データのデータ構造である。このようなデータ構造を有する送信データを用いることで、情報処理装置は、受信した計測情報の位置情報の座標変換の要否を的確に判定することができる。

他の好適な実施形態によれば、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報と、を有する送信データのデータ構造であって、前記座標系情報に基づき前記位置情報の座標変換を行う情報処理装置に送信される送信データのデータ構造である。このようなデータ構造を有する送信データを用いることによっても、情報処理装置は、受信した計測情報の位置情報の座標変換の要否を的確に判定することができる。

上記データ構造の他の一態様では、送信データのデータ構造は、前記計測装置が前記物体を計測した際の前記計測装置の前記移動体への取付位置姿勢に関する情報と、前記計測装置が前記物体を計測した際の前記移動体の位置姿勢に関する情報と、をさらに含む。ここで、「移動体への取付位置姿勢」とは、計測装置が移動体に取り付けられている位置（取り付け位置）又は／及び姿勢（取り付け角度）を指す。情報処理装置は、このデータ構造を有する送信データを受信することで、計測装置の位置を基準とした座標系からの座標変換を好適に実行することができる。

他の好適な実施形態では、記憶装置は、上記いずれかに記載のデータ構造を有するデータを記憶する。記憶装置は、例えば、このようなデータを蓄積して地図更新に用いてもよく、地図更新を行うサーバ装置に送信してもよい。

さらに別の好適な実施形態では、端末装置は、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報を生成する生成部と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段と、を有する。端末装置は、この態様により、送信した計測情報の位置情報の座標変換の要否を的確に情報処理装置に認識させることができる。

さらに別の好適な実施形態では、端末装置は、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成部と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段と、を有する。端末装置は、この態様によっても、送信した計測情報の位置情報の座標変換の要否を的確に情報処理装置に認識させることができる。

さらに別の好適な実施形態では、サーバ装置は、移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信手段と、前記座標系情報に基づき、前記位置情報の座標変換を行う変換手段と、を有する。サーバ装置は、この態様により、受信した計測情報の位置情報の座標変換を好適に実行することができる。

さらに別の好適な実施形態では、端末装置が実行する制御方法であって、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得工程と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報、又は、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成工程と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信工程と、を有する。端末装置は、この制御方法を実行することで、送信した計測情報の位置情報の座標変換の要否を的確に情報処理装置に認識させることができる。

さらに別の好適な実施形態では、サーバ装置が実行する制御方法であって、移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信工程と、前記座標系情報に基づき、前記位置情報の座標変換を行う変換工程と、を有する。サーバ装置は、この制御方法を実行することで、受信した計測情報の位置情報の座標変換を好適に実行することができる。

さらに別の好適な実施形態では、コンピュータが実行するプログラムであって、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報、又は、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成手段と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段として前記コンピュータを機能させる。コンピュータは、このプログラムを実行することで、送信した計測情報の位置情報の座標変換の要否を的確に情報処理装置に認識させることができる。

さらに別の好適な実施形態では、コンピュータが実行するプログラムであって、移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信手段と、前記座標系情報に基づき、前記位置情報の座標変換を行う変換手段として前記コンピュータを機能させる。コンピュータは、このプログラムを実行することで、受信した計測情報の位置情報の座標変換を好適に実行することができる。好適には、これらのプログラムは、記憶媒体に記憶される。

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

［地図更新システムの構成］
図１は、本実施例に係る地図更新システムの概略構成図である。図１に示す地図更新システムは、移動体である各車両と共に移動する車載機１と、各車載機１とネットワークを介して通信を行うサーバ装置６とを備える。そして、地図更新システムは、各車載機１から送信された情報に基づき、サーバ装置６が保有する配信用の地図である配信地図ＤＢ２２を更新する。なお、以後において、「地図」とは、従来の経路案内用の車載機が参照するデータに加えて、ＡＤＡＳ（Ａｄｖａｎｃｅｄ Ｄｒｉｖｅｒ Ａｓｓｉｓｔａｎｃｅ Ｓｙｓｔｅｍ）や自動運転に用いられるデータも含むものとする。また、図１では、車両が１台のみ図示されているが、実際には複数の車両の車載機１がサーバ装置６と通信を行う。

車載機１は、ライダ（Ｌｉｄａｒ：Ｌｉｇｈｔ Ｄｅｔｅｃｔｉｏｎ ａｎｄ Ｒａｎｇｉｎｇ、または、Ｌａｓｅｒ Ｉｌｌｕｍｉｎａｔｅｄ Ｄｅｔｅｃｔｉｏｎ Ａｎｄ Ｒａｎｇｉｎｇ）２、ジャイロセンサ３、加速度センサ４、及びＧＰＳ受信機５などのセンサ群と電気的に接続し、これらの出力に基づき、所定のオブジェクトの検出、及び、車載機１が搭載される車両の位置及び姿勢（単に「自車位置」とも呼ぶ。）の推定などを行う。そして、車載機１は、自車位置の推定結果に基づき、設定された目的地への経路に沿って走行するように、車両の自動運転制御などを行う。車載機１は、道路データ及び道路付近に設けられた目印（ランドマーク）となる地物や区画線等に関する情報などが登録された地図データベース（ＤＢ：ＤａｔａＢａｓｅ）１０を記憶する。そして、車載機１は、この地図ＤＢ１０に基づき、ライダ２等の出力と照合させて自車位置の推定を行う。また、車載機１は、検出したオブジェクトに関する情報を含むアップロード情報「Ｉｕ」をサーバ装置６へ送信する。また、車載機１は、地図ＤＢ１０を更新するためのダウンロード「Ｉｄ」をサーバ装置６から受信する。車載機１は、端末装置の一例である。

ライダ２は、水平方向および垂直方向の所定の角度範囲に対してパルスレーザを出射することで、外界に存在する物体までの距離を離散的に測定し、当該物体の位置を示す３次元の点群情報を生成する。この場合、ライダ２は、照射方向を変えながらレーザ光を照射する照射部と、照射したレーザ光の反射光（散乱光）を受光する受光部と、受光部が出力する受光信号に基づくスキャンデータを出力する出力部とを有する。スキャンデータは、受光部が受光したレーザ光に対応する照射方向と、上述の受光信号に基づき特定される当該レーザ光のその照射方向での物体までの距離とに基づき生成され、車載機１へ供給される。ライダ２は、「計測装置」の一例である。

サーバ装置６は、各車載機１からアップロード情報Ｉｕを受信して記憶する。サーバ装置６は、例えば、収集したアップロード情報Ｉｕに基づき、配信地図ＤＢ２２を更新する。また、サーバ装置６は、配信地図ＤＢ２２の更新情報を含むダウンロード情報Ｉｄを各車載機１へ送信する。サーバ装置６は、情報処理装置及びの一例である。

［車載機の構成］
図２（Ａ）は、車載機１の機能的構成を示すブロック図である。車載機１は、主に、インターフェース１１と、記憶部１２と、通信部１３と、入力部１４と、制御部１５と、情報出力部１６と、を有する。これらの各要素は、バスラインを介して相互に接続されている。

インターフェース１１は、ライダ２、ジャイロセンサ３、加速度センサ４、及びＧＰＳ受信機５などを含むセンサ群９から出力データを取得し、制御部１５へ供給する。また、インターフェース１１は、制御部１５が生成した車両の走行制御に関する信号を車両の電子制御装置（ＥＣＵ：Ｅｌｅｃｔｒｏｎｉｃ Ｃｏｎｔｒｏｌ Ｕｎｉｔ）へ供給する。

記憶部１２は、制御部１５が実行するプログラムや、制御部１５が所定の処理を実行するのに必要な情報を記憶する。本実施例では、記憶部１２は、地図ＤＢ１０と、ライダ設置情報ＩＬとを有する。地図ＤＢ１０は、例えば、道路データ、施設データ、道路周辺の地物データ、及び、障害物データなどを含むデータベースである。道路データには、経路探索用の車道／車線ネットワークデータ、道路形状データ、交通法規データなどが含まれる。地物データは、道路標識等の看板や停止線等の道路標示、白線等の道路区画線や道路沿いの構造物等の情報（例えば位置情報及び種別情報）を含む。また、地物データは、自車位置推定に用いるための地物の高精度な点群情報（例えば３次元地図をボクセルごとの正規分布により近似したボクセルデータ）などを含んでもよい。障害物データには、道路工事、駐車/停車車両、道路上の落下物等に関する位置情報や種別情報を含む。その他、地図ＤＢ１０には、位置推定に必要な種々のデータが記憶されてもよい。

ライダ設置情報ＩＬは、ある基準時（例えばライダ２のアライメント調整直後などの姿勢ずれが生じていない時）におけるライダ２の車両に対する相対的な姿勢及び位置に関する情報である。本実施例では、ライダ２等の姿勢を、ロール角、ピッチ角、ヨー角（即ちオイラー角）により表すものとする。ライダ設置情報ＩＬは、後述するライダ２の姿勢の推定処理が実行された場合に、推定結果に基づき更新されてもよい。

通信部１３は、制御部１５の制御に基づき、アップロード情報Ｉｕをサーバ装置６に送信したり、ダウンロード情報Ｉｄをサーバ装置６から受信したりする。入力部１４は、ユーザが操作するためのボタン、タッチパネル、リモートコントローラ、音声入力装置等であり、経路探索のための目的地を指定する入力、自動運転のオン及びオフを指定する入力などを受け付ける。情報出力部１６は、例えば、制御部１５の制御に基づき出力を行うディスプレイやスピーカ等である。

制御部１５は、プログラムを実行するＣＰＵなどを含み、車載機１の全体を制御する。本実施例では、制御部１５は、自車位置推定部１７と、運転支援制御部１８と、ライダ位置姿勢推定部１９と、アップロード制御部２０と、地図更新部２１と、を有する。制御部１５は、プログラムを実行するコンピュータとして機能する。

自車位置推定部１７は、インターフェース１１から供給されるセンサ群９の出力信号及び地図ＤＢ１０に基づき、自車位置の推定を行う。自車位置推定部１７は、任意の自車位置の推定方法を適用して自車位置の推定を行ってもよい。例えば、自車位置推定部１７は、自車位置推定として、ライダ２による特定の地物の計測結果と、地図ＤＢ１０の地物データに記録された計測対象の地物の位置情報とを用いた位置推定（所謂ランドマーク位置推定）、ボクセルデータを用いたＮＤＴ（Ｎｏｒｍａｌ Ｄｉｓｔｒｉｂｕｔｉｏｎｓ Ｔｒａｎｓｆｏｒｍ）スキャンマッチングによる位置推定、又はＧＰＳ受信機５等を用いた全球測位衛星システム（ＧＮＳＳ：Ｇｌｏｂａｌ Ｎａｖｉｇａｔｉｏｎ Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍ)による位置推定などを行う。

さらに、自車位置推定部１７は、自車位置の推定処理において、推定した自車位置の推定精度（「推定自車位置精度」とも呼ぶ。）に関する情報を生成する。例えば、自車位置推定部１７は、特許文献２等に示されるカルマンフィルタを用いた自車位置推定を行った場合、推定位置の誤差分布に相当する共分散行列の対角要素の平方根を推定自車位置精度として認識する。他の例では、自車位置推定部１７は、ボクセルデータを用いたＮＤＴスキャンマッチングによる位置推定を行う場合、ライダの計測点群とボクセルデータとの一致度を示す評価関数に基づき推定自車位置精度を設定する。さらに別の例では、自車位置推定部１７は、ＧＮＳＳによる位置推定を行った場合には、ＧＰＳ受信機５から得られるＤＯＰ（Ｄｉｌｕｔｉｏｎ Ｏｆ Ｐｒｅｃｉｓｉｏｎ）を推定自車位置精度として取得する。また、自車位置推定部１７は、ＧＮＳＳによる位置推定を行った場合、所定時間内にＧＰＳ受信機５から取得した緯度、経度、高度の各々の標準偏差の値を、推定自車位置精度として取得してもよい。

運転支援制御部１８は、自車位置の推定結果に基づいて自動運転制御を含む車両の運転支援に関する制御を行う。このとき、運転支援制御部１８は、ライダ２の出力データを用いる場合には、ライダ２が出力する計測データを、ライダ設置情報ＩＬに記録されたライダ２の姿勢及び位置を基準として、ライダ２を基準とした座標系から車両を基準とした座標系に変換する。これにより、運転支援制御部１８は、ライダ２により計測される障害物等の車両に対する相対位置を的確に把握して車両の制御や警告などを行う。

ライダ位置姿勢推定部１９は、車両に対するライダ２の現在（即ち処理基準時）の位置又は／及び姿勢（単に「位置姿勢」とも呼ぶ。）を推定することで、ライダ設置情報ＩＬに記録された位置姿勢に対する変化量（「ライダ位置姿勢変化量」とも呼ぶ。）を算出する。車両に対するライダ２の位置姿勢の推定方法は、任意の方法であってもよい。例えば、ライダ２の位置姿勢を検知するための１又は複数のセンサ（例えば変位センサや加速度センサ）がライダ２に設けられている場合には、ライダ位置姿勢推定部１９は、当該センサの出力に基づき、ライダ２の位置姿勢を検出し、ライダ設置情報ＩＬに記録されたライダ２の位置姿勢との差分をライダ位置姿勢変化量として算出する。他の例では、ライダ位置姿勢推定部１９は、３台以上のライダ２が存在する場合には、これらのライダの計測結果を比較することで、位置姿勢のずれが発生しているライダの特定及び当該ライダの位置姿勢のずれ量（即ちライダ位置姿勢変化量）の算出を行う。さらに別の例では、ライダ位置姿勢推定部１９は、走行路に沿った白線などの区画線、走行路の進行方向に対して垂直面を有する道路標識、走行路の幅方向に対して垂直面を有する道路標識などをライダ２により計測し、その計測結果に基づきライダ位置姿勢変化量を検出してもよい。

また、ライダ位置姿勢推定部１９は、ライダ２の位置姿勢の推定を行った場合、推定した位置姿勢の精度（「ライダ位置姿勢推定精度」とも呼ぶ。）を算出する。例えば、ライダ位置姿勢推定部１９は、実行可能なライダ２の位置姿勢の推定手法ごとにライダ位置姿勢精度の値を対応付けたテーブル等を記憶しておき、当該テーブルを参照することで、推定したライダ２の位置姿勢に対するライダ位置姿勢推定精度を決定する。他の例では、ライダ位置姿勢推定部１９は、ライダ２の位置姿勢の推定において使用したセンサの種別情報又は性能に関する情報等に基づき、所定のテーブル等を参照することで、ライダ位置姿勢推定精度を決定してもよい。

アップロード制御部２０は、ライダ２の出力に基づき所定のオブジェクトを検出した場合などに、検出したオブジェクトに関する情報（「オブジェクト情報」とも呼ぶ。）を含むアップロード情報Ｉｕを生成し、アップロード情報Ｉｕをサーバ装置６へ送信する。上述のオブジェクト情報は、少なくともオブジェクトの位置情報（本実施例では、ライダ２による計測値の情報）を含むものであり、オブジェクトの識別情報、オブジェクトの形状、大きさなどのオブジェクトの属性情報がさらに含まれてもよい。また、本実施例では、アップロード制御部２０は、オブジェクト情報に加えて、検出に用いたライダ２の位置姿勢に関する情報（「ライダ位置姿勢情報」とも呼ぶ。）と、自車位置推定部１７が推定した自車位置に関する情報（「自車位置姿勢情報」とも呼ぶ。）と、オブジェクト情報に含まれる計測値の絶対座標系（ワールド座標系）への変換の有無を示すフラグ情報（「座標変換フラグ」とも呼ぶ。）と、をアップロード情報Ｉｕに含める。このアップロード情報Ｉｕのデータ構造については、［アップロード情報のデータ構造］のセクションで詳しく説明する。

地図更新部２１は、サーバ装置６から通信部１３がダウンロード情報Ｉｄを受信した場合に、当該ダウンロード情報Ｉｄを用いて地図ＤＢ１０の更新を行う。

［サーバ装置の構成］
図２（Ｂ）は、サーバ装置６の機能的構成を示すブロック図である。サーバ装置６は、主に、通信部６１と、記憶部６２と、制御部６５とを備える。これらの各要素は、バスラインを介して相互に接続されている。

通信部６１は、制御部６５の制御に基づき、アップロード情報Ｉｕを車載機１から受信したり、ダウンロード情報Ｉｄを車載機１へ送信したりする。記憶部６２は、制御部６５が実行するプログラムや、制御部６５が所定の処理を実行するのに必要な情報を記憶する。本実施例では、記憶部６２は、地図ＤＢ１０と同様のデータ構造を有する配信地図ＤＢ２２と、各車載機１から受信したアップロード情報Ｉｕのデータベースであるアップロード情報ＤＢ２７と、を記憶する。

制御部６５は、プログラムを実行するＣＰＵなどを含み、サーバ装置６の全体を制御する。本実施例では、制御部６５は、アップロード情報ＤＢ２７に含まれるオブジェクト情報等に基づき配信地図ＤＢ２２を更新する処理及び当該更新処理により生成した地図更新情報を含むダウンロード情報Ｉｄを通信部６１により各車載機１へ送信する処理などを行う。制御部６５は、プログラムを実行するコンピュータとして機能する。

［座標系の変換］
ライダ２により取得される３次元点群データの各計測点が示す３次元座標は、ライダ２の位置姿勢を基準とした座標系（「ライダ座標系」とも呼ぶ。）で表されている。よって、ライダ２の計測値を地図に反映させる場合、車両の位置姿勢を基準とした座標系（「車両座標系」とも呼ぶ。）に変換した後、ライダ２の計測値を地図において採用されているワールド座標系（絶対座標系）に変換させる必要がある。

ここで、ライダ座標系での計測値［ｘ_Ｌ（ｉ）、ｙ_Ｌ（ｉ）、ｚ_Ｌ（ｉ）］^Ｔは、ライダ２の位置姿勢にずれが生じていない時の車両座標系におけるライダ２の位置姿勢［Ｌ_ｘ０、Ｌ_ｙ０、Ｌ_ｚ０、Ｌ_φ０、Ｌ_θ０、Ｌ_ψ０］^Ｔを用いた以下の式（１）により、車両座標系の座標値［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）、ｚ_Ｂ（ｉ）］^Ｔに変換される。

「Ｌ_ｘ０」、「Ｌ_ｙ０」、「Ｌ_ｚ０」は、それぞれ、車両座標系におけるライダ２の位置を示し、「Ｌ_φ０」、「Ｌ_θ０」、「Ｌ_ψ０」は、それぞれ、車両座標系に対するライダ２のロール角、ピッチ角、ヨー角を示す。なお、ライダ２の位置姿勢［Ｌ_ｘ０、Ｌ_ｙ０、Ｌ_ｚ０、Ｌ_φ０、Ｌ_θ０、Ｌ_ψ０］^Ｔは、例えばライダ設置情報ＩＬに予め記録されており、「基準取付位置姿勢」の一例である。また、ライダ座標系は、「計測装置の位置を基準とした座標系」の一例である。

ここで、ライダ２の位置姿勢にずれが生じ、その変化量が［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔであった場合、現在のライダ２の位置姿勢［Ｌ_ｘ、Ｌ_ｙ、Ｌ_ｚ、Ｌ_φ、Ｌ_θ、Ｌ_ψ］^Ｔは、以下の式（２）により表される。

この場合、ライダ座標系での計測値［ｘ_Ｌ（ｉ）、ｙ_Ｌ（ｉ）、ｚ_Ｌ（ｉ）］^Ｔは、現在のライダ２の位置姿勢［Ｌ_ｘ、Ｌ_ｙ、Ｌ_ｚ、Ｌ_φ、Ｌ_θ、Ｌ_ψ］を用いて、式（１）と同様の以下の式（３）により、車両座標系の座標値［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）、ｚ_Ｂ（ｉ）］^Ｔに変換することができる。

次に、時刻「ｋ」における自車位置（姿勢を含む）の推定値（「推定自車位置」とも呼ぶ。）を［Ｂ＾_ｘ（ｋ）、Ｂ＾_ｙ（ｋ）、Ｂ＾_ｚ（ｋ）、Ｂ＾_φ（ｋ）、Ｂ＾_θ（ｋ）、Ｂ＾_ψ（ｋ）］^Ｔとすると、車両座標系の座標値［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）、ｚ_Ｂ（ｉ）］^Ｔは、以下の式（４）に基づき、ワールド座標系の座標値［ｘ_Ｗ（ｉ）、ｙ_Ｗ（ｉ）、ｚ_Ｗ（ｉ）］^Ｔに変換される。

従って、車載機１又はサーバ装置６は、ライダ座標系での計測値［ｘ_Ｌ（ｉ）、ｙ_Ｌ（ｉ）、ｚ_Ｌ（ｉ）］^Ｔを得た場合、まず、ライダ２の位置姿勢の情報に基づき、式（３）を用いて車両座標系の座標値［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）、ｚ_Ｂ（ｉ）］^Ｔに変換する。そして、車載機１又はサーバ装置６は、推定自車位置の情報を用いて、式（４）に基づき車両座標系の座標値をワールド座標系の座標値［ｘ_Ｗ（ｉ）、ｙ_Ｗ（ｉ）、ｚ_Ｗ（ｉ）］^Ｔに変換する。これにより、地図と同一の座標系で表されたライダ２の計測値を好適に取得することができ、地図更新に好適に用いることができる。

ここで、ライダ座標系から車両座標系の変換について補足説明する。

図３は、２次元座標により表された車両座標系とライダ座標系との関係を示す図である。ここでは、車両座標系は、車両の中心を原点とし、車両の進行方向に沿った座標軸「Ｘ_Ｂ」と車両の側面方向に沿った座標軸「Ｙ_Ｂ」を有する。また、ライダ座標系は、ライダ２の正面方向（矢印Ａ２参照）に沿った座標軸「Ｘ_Ｌ」とライダ２の側面方向に沿った座標軸「Ｙ_Ｌ」を有する。

ここで、車両座標系に対するライダ２のヨー角を「Ｌ_ψ０」、ライダ２の位置を［Ｌ_ｘ０、Ｌ_ｙ０］^Ｔとした場合、車両座標系から見た時刻ｉの計測点［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）］^Ｔは、回転行列「Ｃ_Ｌψ０」を用いた以下の式（５）によりライダ座標系の座標［ｘ_Ｌ（ｉ）、ｙ_Ｌ（ｉ）］^Ｔへ変換される。

一方、ライダ座標系から車両座標系への変換は、回転行列の逆行列（転置行列）を用いればよい。よって、ライダ座標系で取得した時刻ｉの計測点［ｘ_Ｌ（ｉ）、ｙ_Ｌ（ｉ）］^Ｔは、以下の式（６）により車両座標系の座標［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）］^Ｔに変換することが可能である。

図４は、３次元座標により表された車両座標系とライダ座標系との関係を示す図である。

この場合、車両座標系から見た時刻ｉの計測点［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）、ｚ_Ｂ（ｉ）］^Ｔは、車両座標系に対するライダ２の位置姿勢［Ｌ_ｘ０、Ｌ_ｙ０、Ｌ_ｚ０、Ｌ_φ０、Ｌ_θ０、Ｌ_ψ０］^Ｔと、ロール、ピッチ、ヨーに対応する各回転行列「Ｃ_Ｌφ０」、「Ｃ_Ｌθ０」、「Ｃ_Ｌψ０」により表される方向余弦行列「Ｃ_Ｌ０」とを用いた以下の式（７）により、ライダ座標系の座標［ｘ_Ｌ（ｉ）、ｙ_Ｌ（ｉ）、ｚ_Ｌ（ｉ）］^Ｔへ変換される。

一方、ライダ座標系から車両座標系への変換は、方向余弦行列Ｃ_Ｌ０の逆行列（転置行列）を用いればよい。よって、ライダ座標系で取得した時刻ｉの計測点［ｘ_Ｌ（ｉ）、ｙ_Ｌ（ｉ）、ｚ_Ｌ（ｉ）］^Ｔは、以下の式（８）により車両座標系の座標［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）、ｚ_Ｂ（ｉ）］^Ｔに変換することが可能である。

この式（８）は、式（１）と等価の式となる。

次に、車両座標系からワールド座標系の変換について補足説明する。

図５は、２次元座標により表された車両座標系とワールド座標系との関係を示す図である。ここでは、ワールド座標系は、座標軸「Ｘ_Ｗ」と座標軸「Ｙ_Ｗ」を有する。

ワールド座標系に対する時刻ｋの車両のヨー角の推定値がＢ＾_ψ（ｋ）であり，車両の推定位置がＢ＾_ｘ（ｋ）、Ｂ＾_ｙ（ｋ）であった場合，ワールド座標系から見た点群データの車両座標系への変換は、回転行列「Ｃ_Ｂψ（ｋ）」を用いた以下の式（９）により計算できる。

一方、ライダ座標系から車両座標系への変換は、回転行列Ｃ_Ｂψ（ｋ）の逆行列（転置行列）を用いればよい。よって、［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）］^Ｔは、以下の式（１０）によりワールド座標系の座標［ｘ_Ｗ（ｉ）、ｙ_Ｗ（ｉ）］^Ｔに変換することが可能である。

次に、３次元座標により表された車両座標系とワールド座標系との関係について説明する。

この場合、ワールド座標系から見た時刻ｉの座標値［ｘ_Ｗ（ｉ）、ｙ_Ｗ（ｉ）、ｚ_Ｗ（ｉ）］^Ｔは、時刻ｋにおける自車位置（姿勢を含む）の推定値［Ｂ＾_ｘ（ｋ）、Ｂ＾_ｙ（ｋ）、Ｂ＾_ｚ（ｋ）、Ｂ＾_φ（ｋ）、Ｂ＾_θ（ｋ）、Ｂ＾_ψ（ｋ）］^Ｔと、ロール、ピッチ、ヨーに対応する各回転行列「Ｃ_Ｂφ（ｋ）」、「Ｃ_Ｂθ（ｋ）」、「Ｃ_Ｂψ（ｋ）」により表される方向余弦行列「Ｃ_Ｂ（ｋ）」とを用いた以下の式（１１）により、車両座標系の座標［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）、ｚ_Ｂ（ｉ）］^Ｔへ変換される。

一方、車両座標系からワールド座標系への変換は、方向余弦行列Ｃ_Ｂ（ｋ）の逆行列（転置行列）を用いればよい。よって、車両座標系で取得した時刻ｉの計測点［ｘ_Ｂ（ｉ）、ｙ_Ｂ（ｉ）、ｚ_Ｂ（ｉ）］^Ｔは、以下の式（１２）によりワールド座標系の座標［ｘ_Ｗ（ｉ）、ｙ_Ｗ（ｉ）、ｚ_Ｗ（ｉ）］^Ｔに変換することが可能である。

この式（１２）は、式（４）と等価の式となる。

［アップロード情報のデータ構造］
図６は、アップロード情報Ｉｕのデータ構造の一例を示す。図６の例では、アップロード情報Ｉｕは、「時刻」、「ライダ番号」、「計測値」、「ライダ位置姿勢」、「ライダ位置姿勢変化量」、「ライダ位置姿勢推定精度」、「座標変換フラグ」、「推定自車位置」、「推定自車位置精度」と、を含んでいる。なお、「計測値」は上述したオブジェクト情報に該当し、「ライダ位置姿勢」及び「ライダ位置姿勢変化量」及び「ライダ位置姿勢推定精度」は、上述したライダ位置姿勢情報に該当し、「推定自車位置」及び「推定自車位置精度」は、上述した自車位置姿勢情報に該当する。

車載機１は、「時刻」として、ライダ２による計測を行った時刻又はアップロード情報Ｉｕの送信時刻を指定する。また、車載機１は、「ライダ番号」として、車両に複数のライダ２が搭載されている場合に各ライダ２を識別するための番号を指定する。また、車載機１は、「計測値」として、ライダ２により計測したオブジェクトの計測点群が示すＮ（Ｎは１以上の整数）個の計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔを指定する。なお、この計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔは、ライダ座標系の座標値であってもよく、ワールド座標系の座標値であってもよい。

また、車載機１は、「ライダ位置姿勢」として、車両座標系のライダ２の位置姿勢を指定する。この場合、「ライダ位置姿勢」は、ライダ位置姿勢変化量［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔを加味した現在のライダ２の位置姿勢［Ｌ_ｘ、Ｌ_ｙ、Ｌ_ｚ、Ｌ_φ、Ｌ_θ、Ｌ_ψ］であってもよく、ライダ設置情報ＩＬに記録されたライダ２の位置姿勢［Ｌ_ｘ０、Ｌ_ｙ０、Ｌ_ｚ０、Ｌ_φ０、Ｌ_θ０、Ｌ_ψ０］^Ｔ（即ちライダ２の位置姿勢にずれが生じていない時のライダ２の位置姿勢）であってもよい。後者の場合であっても、アップロード情報Ｉｕを受信したサーバ装置６は、後述する「ライダ位置姿勢変化量」を用いて式（２）に基づき現在のライダ２の位置姿勢［Ｌ_ｘ、Ｌ_ｙ、Ｌ_ｚ、Ｌ_φ、Ｌ_θ、Ｌ_ψ］を特定することが可能である。

また、車載機１は、「ライダ位置姿勢変化量」として、ライダ位置姿勢推定部１９が算出したライダ２の位置姿勢の変化量であるライダ位置姿勢変化量［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔを指定する。また、車載機１は、「ライダ位置姿勢推定精度」として、推定したライダ位置姿勢変化量又は現在のライダ２の位置姿勢に対する推定精度であるライダ位置姿勢推定精度「σ_Ｌｘ、σ_Ｌｙ、σ_Ｌｚ、σ_Ｌφ、σ_Ｌθ、σ_Ｌψ」^Ｔを指定する。ライダ位置姿勢推定精度「σ_Ｌｘ、σ_Ｌｙ、σ_Ｌｚ、σ_Ｌφ、σ_Ｌθ、σ_Ｌψ」^Ｔは、ライダ位置姿勢推定部１９により算出される。

また、車載機１は、「座標変換フラグ」として、「計測値」に指定したライダ２の計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔが車両座標系あるいはワールド座標系に変換されたものであるか否かを示す情報を指定する。本実施形態では、一例として、車載機１は、ライダ２の計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔがワールド座標系に変換されたものである場合には、座標変換フラグを「２」に設定し、ライダ２の計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔが車両座標系に変換されたものである場合には、座標変換フラグを「１」に設定し、ライダ２の計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔが車両座標系にもワールド座標系にも変換されていないもの（即ちライダ座標系のまま）である場合には、座標変換フラグを「０」に設定するものとする。このように、座標変換フラグは、ライダ２の計測値がライダ座標系で示されているか否かを示す座標系情報、及び、ライダ座標系から異なる座標系（ここでは車両座標系あるいはワールド座標系）に変換されたか否かを示す座標系情報に相当する。

また、車載機１は、「推定自車位置」として、ライダ２の計測時に自車位置推定部１７が推定した推定自車位置［Ｂ＾_ｘ、Ｂ＾_ｙ、Ｂ＾_ｚ、Ｂ＾_φ、Ｂ＾_θ、Ｂ＾_ψ］^Ｔを指定する。ここで、Ｂ＾_ｘ、Ｂ＾_ｙ、Ｂ＾_ｚは自車の位置、Ｂ＾_φ、Ｂ＾_θ、Ｂ＾_ψは自車の姿勢を示す。また、車載機１は、「推定自車位置精度」として、ライダ２の計測時に自車位置推定部１７が推定した自車位置の精度である推定自車位置精度「σ_Ｂｘ、σ_Ｂｙ、σ_Ｂｚ、σ_Ｂφ、σ_Ｂθ、σ_Ｂψ」^Ｔを指定する。

なお、アップロード情報Ｉｕには、上述した各項目以外の任意の情報が含まれてもよい。例えば、アップロード情報Ｉｕには、計測対象となった地物を特定するための地物の識別情報（地物ＩＤ）などが含まれてもよい。

［アップロード処理］
次に、アップロード情報Ｉｕの生成及び送信を含むアップロード処理について説明する。図７は、車載機１が実行するアップロード処理の手順を示すフローチャートである。車載機１は、図７のフローチャートの処理を、ライダ２の出力に基づき所定のオブジェクトを検出した場合などに実行する。

まず、車載機１のライダ位置姿勢推定部１９は、ライダ位置姿勢変化量［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔを算出する（ステップＳ１０１）。また、ライダ位置姿勢推定部１９は、ライダ位置姿勢推定精度「σ_Ｌｘ、σ_Ｌｙ、σ_Ｌｚ、σ_Ｌφ、σ_Ｌθ、σ_Ｌψ」^Ｔを算出する（ステップＳ１０２）。

また、車載機１の自車位置推定部１７は、地図ＤＢ１０に含まれる地物の位置情報等と、当該地物のライダ２による計測値とに基づき、自車位置推定を行う（ステップＳ１０３）。ステップＳ１０３での自車位置推定方法は、ランドマーク位置推定、ＮＤＴスキャンマッチングによる位置推定などの任意の位置推定方法であってもよい。これにより、自車位置推定部１７は、推定自車位置［Ｂ＾_ｘ、Ｂ＾_ｙ、Ｂ＾_ｚ、Ｂ＾_φ、Ｂ＾_θ、Ｂ＾_ψ］^Ｔを算出する。また、自車位置推定部１７は、、地図ＤＢ１０及びライダ２の計測値を使用する代わりに、ＧＰＳ受信機５の出力を用いた位置推定（所謂ＧＮＳＳによる位置推定）を行ってもよい。さらに、自車位置推定部１７は、ステップＳ１０３での位置推定の推定精度である推定自車位置精度「σ_Ｂｘ、σ_Ｂｙ、σ_Ｂｚ、σ_Ｂφ、σ_Ｂθ、σ_Ｂψ」^Ｔを算出する（ステップＳ１０４）。

そして、車載機１のアップロード制御部２０は、ライダ２の計測値を車両座標系に変換するか否か判定する（ステップＳ１０５）。この場合、例えば、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換するか否かに関する設定情報を予め記憶している場合には、当該設定情報に基づき、上述の判定を行う。上述の設定情報は、ユーザ入力に基づき生成されてもよい。

そして、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換すべきと判断した場合（ステップＳ１０５；Ｙｅｓ）、ステップＳ１０１で算出したライダ位置姿勢変化量［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔを加味した現在のライダ位置姿勢［Ｌ_ｘ、Ｌ_ｙ、Ｌ_ｚ、Ｌ_φ、Ｌ_θ、Ｌ_ψ］^Ｔに基づき、式（３）により車両座標系の計測値［ｘ_Ｂ、ｙ_Ｂ、ｚ_Ｂ］^Ｔを算出する（ステップＳ１０６）。

一方、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換すべきでない場合（ステップＳ１０５；Ｎｏ）、座標変換フラグを「０」に設定する（ステップＳ１１０）。

そして、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換した値をワールド座標系に変換するか否か判定する（ステップＳ１０７）。この場合、例えば、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換した値をワールド座標系に変換するか否かに関する設定情報を予め記憶している場合には、当該設定情報に基づき、上述の判定を行う。上述の設定情報は、ユーザ入力に基づき生成されてもよい。

そして、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換した値をワールド座標系に変換すべきと判断した場合（ステップＳ１０７；Ｙｅｓ）、座標変換フラグを「２」に設定する（ステップＳ１０８）。そして、この場合、アップロード制御部２０は、ステップＳ１０３で算出した推定自車位置［Ｂ＾_ｘ、Ｂ＾_ｙ、Ｂ＾_ｚ、Ｂ＾_φ、Ｂ＾_θ、Ｂ＾_ψ］^Ｔに基づき、式（４）により、ワールド座標系の計測値［ｘ_Ｗ（ｉ）、ｙ_Ｗ（ｉ）、ｚ_Ｗ（ｉ）］^Ｔを算出する（ステップＳ１１１）。

一方、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換した値をワールド座標系に変換すべきでない場合（ステップＳ１０７；Ｎｏ）、座標変換フラグを「１」に設定する（ステップＳ１０９）。

ステップＳ１０９、ステップＳ１１０、又はステップＳ１１１のいずれかの実行後、アップロード制御部２０は、図６に示す「時刻」、「ライダ番号」、「計測値」、「ライダ位置姿勢」、「ライダ位置姿勢変化量」、「ライダ位置姿勢推定精度」、「座標変換フラグ」、「推定自車位置」、「推定自車位置精度」の各項目に該当する情報を含むアップロード情報Ｉｕを生成し、当該アップロード情報Ｉｕをサーバ装置６へ送信する（ステップＳ１１２）。これにより、車載機１は、ライダ２の計測値に基づきサーバ装置６が地図を更新するのに必要な情報を好適にサーバ装置６に送信することができる。尚、「計測値」はライダ２の計測値またはライダ２の計測値を車両座標系に変換した値である。

［地図更新処理］
次に、受信したアップロード情報Ｉｕに基づき地図ＤＢ１０及び配信地図ＤＢ２２の更新情報を生成する処理である地図更新処理について説明する。図８は、サーバ装置６が実行する地図更新処理のフローチャートである。サーバ装置６は、図８に示すフローチャートの処理を繰り返し実行する。

まず、サーバ装置６は、各車両の車載機１から送信されるアップロード情報Ｉｕを受信することでアップロード情報Ｉｕを収集する（ステップＳ２０１）。そして、サーバ装置６は、受信したアップロード情報Ｉｕをアップロード情報ＤＢ２７に記憶する。

そして、サーバ装置６は、地図更新を行う所定のタイミングにおいて、アップロード情報ＤＢ２７に記録されたアップロード情報Ｉｕの各々の座標変換フラグを参照し、座標変換フラグが０または１となるアップロード情報Ｉｕの存在の有無を判定する。そして、サーバ装置６は、座標変換フラグが０であるアップロード情報Ｉｕが存在する場合には、当該アップロード情報Ｉｕに含まれるライダ位置姿勢、ライダ位置姿勢変化量、及び推定自車位置から、当該アップロード情報Ｉｕに含まれるライダ２の計測値をワールド座標系に変換する。一方、座標変換フラグが１であるアップロード情報Ｉｕが存在する場合には、サーバ装置６は、当該アップロード情報Ｉｕに含まれる推定自車位置から、当該アップロード情報Ｉｕに含まれるライダ２の計測値を車両座標系に変換した値をワールド座標系に変換する（ステップＳ２０２）。これにより、サーバ装置６は、アップロード情報Ｉｕにライダ座標系の計測値や車両座標系の計測値が含まれる場合であっても、地図において採用されるワールド座標系の座標値にライダ２の計測値やライダ２の計測値を車両座標系に変換した値を好適に変換することができる。

次に、サーバ装置６は、ライダ位置姿勢変化量［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔの各要素のうちいずれかが所定の閾値（「第１閾値」とも呼ぶ。）以上となるものが存在するか否か判定する。さらに、サーバ装置６は、ライダ位置姿勢推定精度「σ_Ｌｘ、σ_Ｌｙ、σ_Ｌｚ、σ_Ｌφ、σ_Ｌθ、σ_Ｌψ」^Ｔの各要素のうちいずれかが所定の閾値（「第２閾値」とも呼ぶ。）以上となるものが存在するか否か判定する。これに加えて、サーバ装置６は、推定自車位置精度「σ_Ｂｘ、σ_Ｂｙ、σ_Ｂｚ、σ_Ｂφ、σ_Ｂθ、σ_Ｂψ」^Ｔの各要素のうちいずれかが所定の閾値（「第３閾値」とも呼ぶ。）以上となるものが存在するか否か判定する（ステップＳ２０３）。第１～第３閾値は、ライダ２の計測値の精度が地図更新に使用できる程度の精度を有するか否かを判定するための閾値である。第１～第３閾値は、比較対象の要素ごとにそれぞれ適切な値となるように比較対象の要素ごとに異なる値に設定されてもよい。なお、ここでは、ライダ位置姿勢推定精度「σ_Ｌｘ、σ_Ｌｙ、σ_Ｌｚ、σ_Ｌφ、σ_Ｌθ、σ_Ｌψ」^Ｔ及び推定自車位置精度「σ_Ｂｘ、σ_Ｂｙ、σ_Ｂｚ、σ_Ｂφ、σ_Ｂθ、σ_Ｂψ」^Ｔの各要素は、例えば標準偏差等の値であり、いずれも、低い値ほど精度が高いことを示すものとする。

そして、サーバ装置６は、ライダ位置姿勢変化量の各要素のうちいずれかが第１閾値以上となるものが存在する場合、又は、ライダ位置姿勢推定精度の各要素のうちいずれかが第２閾値以上となるものが存在する場合、若しくは、推定自車位置精度の各要素のうちいずれかが第３閾値以上となるものが存在する場合（ステップＳ２０３；Ｙｅｓ）、対象のアップロード情報Ｉｕに含まれるライダ２の計測値の精度が低く、地図更新に用いるほどの信頼性がないと判断する。よって、この場合、サーバ装置６は、対象のアップロード情報Ｉｕに含まれる計測値を後述するステップＳ２０６の平均処理において使用しない、又は、平均処理における重み付け値を０に設定する（ステップＳ２０５）。これにより、サーバ装置６は、事故等に起因してライダ位置姿勢変化量が大きくなったライダ２の計測値、ライダ位置姿勢推定精度が低いライダ位置姿勢に基づき座標変換がなされたライダ２の計測値、及び、推定自車位置精度が低い推定自車位置に基づき座標変換がなされたライダ２の計測値などを地図更新において使用するのを好適に抑制することができる。

一方、サーバ装置６は、ライダ位置姿勢変化量の各要素がいずれも第１閾値未満となり、かつ、ライダ位置姿勢推定精度の各要素がいずれも第２閾値未満となり、かつ、推定自車位置精度の各要素のいずれもが第３閾値未満となる場合（ステップＳ２０３；Ｎｏ）、対象のアップロード情報Ｉｕに含まれるライダ２の計測値の精度が地図更新に用いることができる程度に高いと判断する。よって、この場合、サーバ装置６は、ライダ位置姿勢変化量、ライダ位置姿勢推定精度、及び推定自車位置精度に応じて、対象のアップロード情報Ｉｕに含まれるライダ２の計測値に対する重み付け値を設定する（ステップＳ２０４）。この場合、例えば、サーバ装置６は、ライダ位置姿勢変化量、ライダ位置姿勢推定精度、及び推定自車位置精度の各要素から重み付け値を決定するための式又はマップを参照することで、上述の重み付け値を設定する。この場合、サーバ装置６は、ライダ位置姿勢変化量が小さいほど上述の重み付け値を大きくし、ライダ位置姿勢推定精度が小さいほど上述の重み付け値を大きくし、推定自車位置精度が小さいほど上述の重み付け値を大きくするように、上述の重み付け値を決定する。これにより、サーバ装置６は、地図更新に用いるライダ２の計測値の各々に対し、その計測値の精度に応じた適切な重み付け値を好適に設定することができる。

次に、サーバ装置６は、各計測値に対して、ステップＳ２０４又はステップＳ２０５で設定した重み付け値による重み付け平均処理を行うことで、統合データを生成する（ステップＳ２０６）。統合データは、例えば、各計測値を統計処理することで算出した地物の位置情報などが該当する。このように、サーバ装置６は、計測値の信頼度（精度）に応じて設定した重み付け値を用いることで、高精度な統合データを生成することができる。ステップＳ２０６の具体例については後述する。そして、サーバ装置６は、ステップＳ２０６で生成した統合データを用いて配信地図ＤＢ２２を更新する（ステップＳ２０７）。その後、サーバ装置６は、生成した統合データを含むダウンロード情報Ｉｄを各車載機１へ送信する。

ここで、ステップＳ２０６の処理の具体例について説明する。ここでは、統合データとして、配信地図ＤＢ２２に登録するオブジェクト（地物）の絶対位置（「オブジェクト推定位置」とも呼ぶ。）を算出する例について説明する。なお、サーバ装置６は、この場合、例えば、アップロード情報Ｉｕに含まれるライダ２の計測値をオブジェクトごとに分類し、オブジェクトごとにオブジェクト推定位置を算出する。この場合、サーバ装置６は、配信地図ＤＢ２２に登録された各オブジェクトの位置情報に基づき計測値をオブジェクトごとに分類してもよく、公知のクラスタリング技術に基づき上述の分類を行ってもよく、ユーザ入力に基づき上述の分類を行ってもよい。また、車載機１がライダ２により計測したオブジェクトごとにアップロード情報Ｉｕを生成し、計測したオブジェクトの識別情報をアップロード情報Ｉｕに含めている場合には、サーバ装置６は、当該識別情報に基づき、上述の分類を行ってもよい。

ここで、各アップロード情報Ｉｕにより示されるワールド座標系のオブジェクトの計測値を［ｐ_ｘ、ｐ_ｙ、ｐ_ｚ］^Ｔとし、ステップＳ２０４又はステップＳ２０５で設定した重み付け値を［ｗ_ｘ（ｋ）、ｗ_ｙ（ｋ）、ｗ_ｚ（ｋ）］^Ｔとする。そして、サーバ装置６は、複数の車両からそれぞれ複数の時刻のｍ個のアップロード情報Ｉｕを受信した場合，以下の式（１３）～式（１５）が示す重み付け平均処理により、配信地図ＤＢ２２に反映すべきオブジェクトの位置［ｐ^＾ _ｘ、ｐ^＾ _ｙ、ｐ^＾ _ｚ］^Ｔを算出する。

このように、サーバ装置６は、重み付け平均処理により、配信地図ＤＢ２２に反映すべきオブジェクトの位置を好適に算出することができる。

以上説明したように、本実施例に係るアップロード情報Ｉｕのデータ構造は、車両に取り付けられたライダ２が計測した物体を示す計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔと、ライダ２が物体を計測した際の、ライダ２の車両への基準取付姿勢に対する車両への取付姿勢の変化量であるライダ位置姿勢変化量［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔとを有する。そして、このアップロード情報Ｉｕは、ライダ位置姿勢変化量［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔに基づき、計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔの座標系をワールド座標系に変換するサーバ装置６に送信される。

また、以上説明したように、本実施例に係るアップロード情報Ｉｕのデータ構造は、車両に取り付けられたライダ２が計測した物体を示す計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔと、当該計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔが、ライダ２の位置を基準としたライダ座標系で示されているか否か（言い換えると、ライダ座標系から車両座標系あるいはワールド座標系に変換されたか否か）を示す座標変換フラグとを有する。そして、このアップロード情報Ｉｕは、座標変換フラグに基づき、計測値［ｘ_ｉ、ｙ_ｉ、ｚ_ｉ］^Ｔの座標系をワールド座標系に変換するサーバ装置６に送信される。

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

（変形例１）
図１に示す地図更新システムの構成は一例であり、本発明が適用可能な地図更新システムの構成は図１に示す構成に限定されない。例えば、地図更新システムは、車載機１を有する代わりに、車両の電子制御装置が図７等に示す処理を実行してもよい。この場合、ライダ設置情報ＩＬ及び地図ＤＢ１０等は、例えば車両内の記憶部に記憶され、車両の電子制御装置は、ライダ２の出力データを受信し、ライダ設置情報ＩＬ及び地図ＤＢ１０を参照することで、図７等に示す処理を実行する。

（変形例２）
車載機１のライダ位置姿勢推定部１９が実行するライダ位置姿勢変化量［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔ等の算出処理を、サーバ装置６の制御部６５が代わりに実行してもよい。

この場合、例えば、車載機１がサーバ装置６に送信するアップロード情報Ｉｕには、ライダ２の位置姿勢にずれが生じていない時の車両座標系におけるライダ２の位置姿勢［Ｌ_ｘ０、Ｌ_ｙ０、Ｌ_ｚ０、Ｌ_φ０、Ｌ_θ０、Ｌ_ψ０］^Ｔの情報、及び、ライダ２の位置姿勢を検知するための１又は複数のセンサの出力データなどが含まれる。そして、サーバ装置６は、アップロード情報Ｉｕを受信した場合に、アップロード情報Ｉｕに含まれるセンサの出力データ等に基づき、ライダ位置姿勢推定部１９と同様にライダ２の位置姿勢を推定することで、ライダ位置姿勢変化量［ΔＬ_ｘ、ΔＬ_ｙ、ΔＬ_ｚ、ΔＬ_φ、ΔＬ_θ、ΔＬ_ψ］^Ｔの算出及びライダ位置姿勢精度「σ_Ｌｘ、σ_Ｌｙ、σ_Ｌｚ、σ_Ｌφ、σ_Ｌθ、σ_Ｌψ」^Ｔの算出を行う。この態様によっても、サーバ装置６は、図８に示す地図更新処理に必要な情報を取得して配信地図ＤＢ２２の更新を好適に実行することができる。

（変形例３）
図６に示すアップロード情報Ｉｕのデータ構造は一例であり、本発明に適用可能なデータ構造はこれに限定されない。

例えば、アップロード情報Ｉｕには、座標変換フラグが含まれていなくともよい。この場合、例えば、アップロード情報Ｉｕに含まれる計測値は、必ずライダ座標系により表されており、アップロード情報Ｉｕを受信したサーバ装置６は、受信した全てのアップロード情報Ｉｕの計測値に対して、ライダ座標系からワールド座標系への座標変換の処理を行う。

他の例では、座標変換フラグが「２」である場合、即ち、アップロード情報Ｉｕの計測値がワールド座標系により表されている場合には、アップロード情報Ｉｕには、「ライダ位置姿勢」及び「推定自車位置」等は含まれなくともよい。また、座標変換フラグが「１」である場合、即ち、アップロード情報Ｉｕの計測値が車両座標系により表されている場合には、アップロード情報Ｉｕには、「ライダ位置姿勢」等は含まれなくともよい。

さらに別の例では、ライダ設置情報ＩＬに含まれるライダ２の初期の位置姿勢［Ｌ_ｘ０、Ｌ_ｙ０、Ｌ_ｚ０、Ｌ_φ０、Ｌ_θ０、Ｌ_ψ０］^Ｔ等の情報が予めサーバ装置６に記憶されている場合には、アップロード情報Ｉｕには、「ライダ位置姿勢」が含まれていなくともよい。この場合であっても、サーバ装置６は、アップロード情報Ｉｕに含まれるライダ位置姿勢変化量と、予め記憶したライダ２の初期の位置姿勢とに基づき、現在のライダ２の位置姿勢を好適に特定し、計測値の座標変換に用いることができる。

（変形例４）
サーバ装置６は、図８のステップＳ２０６における重み付け平均処理を行う代わりに、全ての計測値を等しい重みにより平均処理（即ち重み付け値によらない平均化）を行ってもよい。この場合、アップロード情報Ｉｕには、ライダ位置姿勢推定精度及び推定自車位置精度等の重み付け値の決定にのみ用いる情報が含まれなくともよい。

１ 車載機
２ ライダ
３ ジャイロセンサ
４ 加速度センサ
５ ＧＰＳ受信機
６ サーバ装置
１０ 地図ＤＢ
２２ 配信地図ＤＢ

Claims (12)

1. 移動体に取り付けられた計測装置が計測した前記移動体周辺の計測情報と、前記計測装置が前記計測情報を計測した際の前記移動体の位置推定精度に関する情報と、を取得する取得部と、
   前記位置推定精度に関する情報に基づき、前記計測情報を用いた地図更新を行う更新部と、
   を有する情報処理装置。
2. 前記取得部は、前記計測装置の前記移動体への取付位置姿勢又は前記取付位置姿勢の変化量の算出精度を示す情報をさらに取得し、
   前記更新部は、前記位置推定精度に関する情報と、前記算出精度を示す情報とに基づき、前記地図更新を行う、
   請求項１に記載の情報処理装置。
3. 前記取得部は、前記計測装置が前記物体を計測した際の前記移動体の位置姿勢に関する情報をさらに取得し、
   前記取得部は、前記位置推定精度に関する情報と、前記位置姿勢に関する情報とに基づき、前記地図更新を行う、請求項１または２に記載の情報処理装置。
4. 前記位置姿勢に関する情報には、前記位置姿勢を示す情報と、前記位置姿勢の算出精度を示す情報とが含まれる請求項３に記載の情報処理装置。
5. 前記計測装置の前記移動体への取付位置姿勢の変化量に関する情報に基づき、前記計測情報の座標系を絶対座標系に変換する変換手段をさらに有し、
   前記更新部は、前記絶対座標系に変換した前記計測情報を用いた前記地図更新を行う、請求項１～４のいずれか一項に記載の情報処理装置。
6. 前記絶対座標系に変換した複数の計測情報に基づき、前記地図更新を行う、請求項５に記載の情報処理装置。
7. 前記更新部は、前記絶対座標系に変換した複数の計測情報のうち、前記変化量が所定量以上となる計測情報を除外して前記地図更新を行う、請求項６に記載の情報処理装置。
8. 前記更新部は、前記絶対座標系に変換した複数の計測情報のうち、前記取付位置姿勢又は前記変化量の算出精度が所定度合より悪いことを示す計測情報を除外して前記地図更新を行う、請求項６または７に記載の情報処理装置。
9. 前記更新部は、前記絶対座標系に変換した複数の計測情報のうち、前記移動体の位置姿勢の算出精度が所定度合より悪いことを示す計測情報を除外して前記地図更新を行う、請求項６～８のいずれか一項に記載の情報処理装置。
10. 情報処理装置が実行する制御方法であって、
    移動体に取り付けられた計測装置が計測した前記移動体周辺の計測情報と、前記計測装置が前記計測情報を計測した際の前記移動体の位置推定精度に関する情報と、を取得する取得工程と、
    前記位置推定精度に関する情報に基づき、前記計測情報を用いた地図更新を行う更新工程と、
    を有する制御方法。
11. コンピュータが実行するプログラムであって、
    移動体に取り付けられた計測装置が計測した前記移動体周辺の計測情報と、前記計測装置が前記計測情報を計測した際の前記移動体の位置推定精度に関する情報と、を取得する取得部と、
    前記位置推定精度に関する情報に基づき、前記計測情報を用いた地図更新を行う更新部
    として前記コンピュータを機能させるプログラム。
12. 請求項１１に記載のプログラムを記憶した記憶媒体。

Images