(57)【要約】【課題】移動体に取り付けられた計測装置が計測した計測情報を送信する際に好適な送信データのデータ構造並びに当該送信データの授受を行う端末装置及びサーバ装置を提供する【解決手段】アップロード情報Ｉｕのデータ構造は、車両に取り付けられたライダ２が計測した物体を示す計測値［ｘｉ、ｙｉ、ｚｉ］Ｔと、当該計測値［ｘｉ、ｙｉ、ｚｉ］Ｔが、ライダ２の位置を基準としたライダ座標系で示されているか否か（言い換えると、ライダ座標系からワールド座標系に変換されたか否か）を示す座標変換フラグとを有する。そして、このアップロード情報Ｉｕは、座標変換フラグに基づき、計測値［ｘｉ、ｙｉ、ｚｉ］Ｔの座標系をワールド座標系に変換するサーバ装置６に送信される。【選択図】図６
2020046413.tif 000002
【特許請求の範囲】
【請求項１】
移動体に配置された計測装置が計測した物体の位置情報を含む計測情報と、
前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報と、を有する送信データのデータ構造であって、
前記座標系情報に基づき前記位置情報の座標変換を行う情報処理装置に送信される送信データのデータ構造。
【請求項２】
移動体に配置された計測装置が計測した物体の位置情報を含む計測情報と、
前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報と、を有する送信データのデータ構造であって、
前記座標系情報に基づき前記位置情報の座標変換を行う情報処理装置に送信される送信データのデータ構造。
【請求項３】
前記計測装置が前記物体を計測した際の前記計測装置の前記移動体への取付位置姿勢に関する情報と、
前記計測装置が前記物体を計測した際の前記移動体の位置姿勢に関する情報と、
をさらに含む請求項１または２に記載のデータ構造。
【請求項４】
請求項１〜３のいずれか一項に記載のデータ構造のデータを記憶する記憶装置。
【請求項５】
移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、
前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報を生成する生成部と、
前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段と、
を有する端末装置。
【請求項６】
移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、
前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成部と、
前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段と、
を有する端末装置。
【請求項７】
移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信手段と、
前記座標系情報に基づき、前記位置情報の座標変換を行う変換手段と、
を有するサーバ装置。
【請求項８】
端末装置が実行する制御方法であって、
移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得工程と、
前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報、又は、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成工程と、
前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信工程と、
を有する制御方法。
【請求項９】
サーバ装置が実行する制御方法であって、
移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信工程と、
前記座標系情報に基づき、前記位置情報の座標変換を行う変換工程と、
を有する制御方法。
【請求項１０】
コンピュータが実行するプログラムであって、
移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、
前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報、又は、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成手段と、
前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段
として前記コンピュータを機能させるプログラム。
【請求項１１】
コンピュータが実行するプログラムであって、
移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信手段と、
前記座標系情報に基づき、前記位置情報の座標変換を行う変換手段
として前記コンピュータを機能させるプログラム。
【請求項１２】
請求項１０または１１に記載のプログラムを記憶した記憶媒体。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、計測装置の取り付け位置及び姿勢に関する情報を活用する技術に関する。
【背景技術】
【０００２】
従来から、レーダやカメラなどの計測装置の計測データに基づいて、自車位置推定などを行う技術が知られている。例えば、特許文献１には、計測センサの出力と、予め地図上に登録された地物の位置情報とを照合させることで自己位置を推定する技術が開示されている。また、特許文献２には、カルマンフィルタを用いた自車位置推定技術が開示されている。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２０１３−２５７７４２号公報
【特許文献２】特開２０１７−７２４２２号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
計測装置から得られるデータは、計測装置を基準とした座標系の値であり、車両に対する計測装置の姿勢等に依存したデータとなっているため、車両を基準とした座標系の値に変換する必要がある。従って、計測装置の位置や姿勢にずれが生じた場合には、そのずれを的確に検知して計測装置のデータに反映させる必要がある。
【０００５】
本発明は、上記のような課題を解決するためになされたものであり、移動体に取り付けられた計測装置が計測した計測情報を送信する際に好適な送信データのデータ構造並びに当該送信データの授受を行う端末装置及びサーバ装置を提供することを主な目的とする。
【課題を解決するための手段】
【０００６】
請求項に記載の発明は、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報と、を有する送信データのデータ構造であって、前記座標系情報に基づき前記位置情報の座標変換を行う情報処理装置に送信される送信データのデータ構造である。
【０００７】
また、請求項に記載の発明は、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報と、を有する送信データのデータ構造であって、前記座標系情報に基づき前記位置情報の座標変換を行う情報処理装置に送信される送信データのデータ構造である。
【０００８】
また、請求項に記載の発明は、端末装置であって、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報を生成する生成部と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段と、を有する。
【０００９】
また、請求項に記載の発明は、端末装置であって、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成部と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段と、を有する。
【００１０】
また、請求項に記載の発明は、サーバ装置であって、移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信手段と、前記座標系情報に基づき、前記位置情報の座標変換を行う変換手段と、を有する。
【００１１】
また、請求項に記載の発明は、端末装置が実行する制御方法であって、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得工程と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報、又は、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成工程と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信工程と、を有する。
【００１２】
また、請求項に記載の発明は、サーバ装置が実行する制御方法であって、移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信工程と、前記座標系情報に基づき、前記位置情報の座標変換を行う変換工程と、を有する。
【００１３】
また、請求項に記載の発明は、コンピュータが実行するプログラムであって、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報、又は、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成手段と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段として前記コンピュータを機能させる。
【００１４】
また、請求項に記載の発明は、コンピュータが実行するプログラムであって、移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信手段と、前記座標系情報に基づき、前記位置情報の座標変換を行う変換手段として前記コンピュータを機能させる。
【図面の簡単な説明】
【００１５】
【図１】地図更新システムの概略構成図である。
【図２】車載機及びサーバ装置の機能的構成を示すブロック図である。
【図３】２次元座標により表された車両座標系とライダ座標系との関係を示す図である。
【図４】３次元座標により表された車両座標系とライダ座標系との関係を示す図である。
【図５】２次元座標により表された車両座標系とワールド座標系との関係を示す図である。
【図６】アップロード情報のデータ構造を示す。
【図７】アップロード処理のフローチャートである。
【図８】地図更新処理のフローチャートである。
【発明を実施するための形態】
【００１６】
好適な実施形態によれば、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報と、を有する送信データのデータ構造であって、前記座標系情報に基づき前記位置情報の座標変換を行う情報処理装置に送信される送信データのデータ構造である。このようなデータ構造を有する送信データを用いることで、情報処理装置は、受信した計測情報の位置情報の座標変換の要否を的確に判定することができる。
【００１７】
他の好適な実施形態によれば、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報と、を有する送信データのデータ構造であって、前記座標系情報に基づき前記位置情報の座標変換を行う情報処理装置に送信される送信データのデータ構造である。このようなデータ構造を有する送信データを用いることによっても、情報処理装置は、受信した計測情報の位置情報の座標変換の要否を的確に判定することができる。
【００１８】
上記データ構造の他の一態様では、送信データのデータ構造は、前記計測装置が前記物体を計測した際の前記計測装置の前記移動体への取付位置姿勢に関する情報と、前記計測装置が前記物体を計測した際の前記移動体の位置姿勢に関する情報と、をさらに含む。ここで、「移動体への取付位置姿勢」とは、計測装置が移動体に取り付けられている位置（取り付け位置）又は／及び姿勢（取り付け角度）を指す。情報処理装置は、このデータ構造を有する送信データを受信することで、計測装置の位置を基準とした座標系からの座標変換を好適に実行することができる。
【００１９】
他の好適な実施形態では、記憶装置は、上記いずれかに記載のデータ構造を有するデータを記憶する。記憶装置は、例えば、このようなデータを蓄積して地図更新に用いてもよく、地図更新を行うサーバ装置に送信してもよい。
【００２０】
さらに別の好適な実施形態では、端末装置は、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報を生成する生成部と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段と、を有する。端末装置は、この態様により、送信した計測情報の位置情報の座標変換の要否を的確に情報処理装置に認識させることができる。
【００２１】
さらに別の好適な実施形態では、端末装置は、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成部と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段と、を有する。端末装置は、この態様によっても、送信した計測情報の位置情報の座標変換の要否を的確に情報処理装置に認識させることができる。
【００２２】
さらに別の好適な実施形態では、サーバ装置は、移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信手段と、前記座標系情報に基づき、前記位置情報の座標変換を行う変換手段と、を有する。サーバ装置は、この態様により、受信した計測情報の位置情報の座標変換を好適に実行することができる。
【００２３】
さらに別の好適な実施形態では、端末装置が実行する制御方法であって、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得工程と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報、又は、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成工程と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信工程と、を有する。端末装置は、この制御方法を実行することで、送信した計測情報の位置情報の座標変換の要否を的確に情報処理装置に認識させることができる。
【００２４】
さらに別の好適な実施形態では、サーバ装置が実行する制御方法であって、移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信工程と、前記座標系情報に基づき、前記位置情報の座標変換を行う変換工程と、を有する。サーバ装置は、この制御方法を実行することで、受信した計測情報の位置情報の座標変換を好適に実行することができる。
【００２５】
さらに別の好適な実施形態では、コンピュータが実行するプログラムであって、移動体に配置された計測装置が計測した物体の位置情報を含む計測情報を取得する取得手段と、前記位置情報が、前記計測装置の位置を基準とした座標系で示されているか否かを示す座標系情報、又は、前記位置情報が、前記計測装置の位置を基準とした座標系から異なる座標系に変換されたか否かを示す座標系情報を生成する生成手段と、前記計測情報と、前記座標系情報とを、情報処理装置に送信する送信手段として前記コンピュータを機能させる。コンピュータは、このプログラムを実行することで、送信した計測情報の位置情報の座標変換の要否を的確に情報処理装置に認識させることができる。
【００２６】
さらに別の好適な実施形態では、コンピュータが実行するプログラムであって、移動体に取り付けられた計測装置が計測した物体の位置情報を含む計測情報と、前記位置情報の座標系に関する座標系情報と、を端末装置から受信する受信手段と、前記座標系情報に基づき、前記位置情報の座標変換を行う変換手段として前記コンピュータを機能させる。コンピュータは、このプログラムを実行することで、受信した計測情報の位置情報の座標変換を好適に実行することができる。好適には、これらのプログラムは、記憶媒体に記憶される。
【実施例】
【００２７】
以下、図面を参照して本発明の好適な各実施例について説明する。
【００２８】
［地図更新システムの構成］
図１は、本実施例に係る地図更新システムの概略構成図である。図１に示す地図更新システムは、移動体である各車両と共に移動する車載機１と、各車載機１とネットワークを介して通信を行うサーバ装置６とを備える。そして、地図更新システムは、各車載機１から送信された情報に基づき、サーバ装置６が保有する配信用の地図である配信地図ＤＢ２２を更新する。なお、以後において、「地図」とは、従来の経路案内用の車載機が参照するデータに加えて、ＡＤＡＳ（Ａｄｖａｎｃｅｄ  Ｄｒｉｖｅｒ  Ａｓｓｉｓｔａｎｃｅ  Ｓｙｓｔｅｍ）や自動運転に用いられるデータも含むものとする。また、図１では、車両が１台のみ図示されているが、実際には複数の車両の車載機１がサーバ装置６と通信を行う。
【００２９】
車載機１は、ライダ（Ｌｉｄａｒ：Ｌｉｇｈｔ  Ｄｅｔｅｃｔｉｏｎ  ａｎｄ  Ｒａｎｇｉｎｇ、または、Ｌａｓｅｒ  Ｉｌｌｕｍｉｎａｔｅｄ  Ｄｅｔｅｃｔｉｏｎ  Ａｎｄ  Ｒａｎｇｉｎｇ）２、ジャイロセンサ３、加速度センサ４、及びＧＰＳ受信機５などのセンサ群と電気的に接続し、これらの出力に基づき、所定のオブジェクトの検出、及び、車載機１が搭載される車両の位置及び姿勢（単に「自車位置」とも呼ぶ。）の推定などを行う。そして、車載機１は、自車位置の推定結果に基づき、設定された目的地への経路に沿って走行するように、車両の自動運転制御などを行う。車載機１は、道路データ及び道路付近に設けられた目印（ランドマーク）となる地物や区画線等に関する情報などが登録された地図データベース（ＤＢ：ＤａｔａＢａｓｅ）１０を記憶する。そして、車載機１は、この地図ＤＢ１０に基づき、ライダ２等の出力と照合させて自車位置の推定を行う。また、車載機１は、検出したオブジェクトに関する情報を含むアップロード情報「Ｉｕ」をサーバ装置６へ送信する。また、車載機１は、地図ＤＢ１０を更新するためのダウンロード「Ｉｄ」をサーバ装置６から受信する。車載機１は、端末装置の一例である。
【００３０】
ライダ２は、水平方向および垂直方向の所定の角度範囲に対してパルスレーザを出射することで、外界に存在する物体までの距離を離散的に測定し、当該物体の位置を示す３次元の点群情報を生成する。この場合、ライダ２は、照射方向を変えながらレーザ光を照射する照射部と、照射したレーザ光の反射光（散乱光）を受光する受光部と、受光部が出力する受光信号に基づくスキャンデータを出力する出力部とを有する。スキャンデータは、受光部が受光したレーザ光に対応する照射方向と、上述の受光信号に基づき特定される当該レーザ光のその照射方向での物体までの距離とに基づき生成され、車載機１へ供給される。ライダ２は、「計測装置」の一例である。
【００３１】
サーバ装置６は、各車載機１からアップロード情報Ｉｕを受信して記憶する。サーバ装置６は、例えば、収集したアップロード情報Ｉｕに基づき、配信地図ＤＢ２２を更新する。また、サーバ装置６は、配信地図ＤＢ２２の更新情報を含むダウンロード情報Ｉｄを各車載機１へ送信する。サーバ装置６は、情報処理装置及びの一例である。
【００３２】
［車載機の構成］
図２（Ａ）は、車載機１の機能的構成を示すブロック図である。車載機１は、主に、インターフェース１１と、記憶部１２と、通信部１３と、入力部１４と、制御部１５と、情報出力部１６と、を有する。これらの各要素は、バスラインを介して相互に接続されている。
【００３３】
インターフェース１１は、ライダ２、ジャイロセンサ３、加速度センサ４、及びＧＰＳ受信機５などを含むセンサ群９から出力データを取得し、制御部１５へ供給する。また、インターフェース１１は、制御部１５が生成した車両の走行制御に関する信号を車両の電子制御装置（ＥＣＵ：Ｅｌｅｃｔｒｏｎｉｃ  Ｃｏｎｔｒｏｌ  Ｕｎｉｔ）へ供給する。
【００３４】
記憶部１２は、制御部１５が実行するプログラムや、制御部１５が所定の処理を実行するのに必要な情報を記憶する。本実施例では、記憶部１２は、地図ＤＢ１０と、ライダ設置情報ＩＬとを有する。地図ＤＢ１０は、例えば、道路データ、施設データ、道路周辺の地物データ、及び、障害物データなどを含むデータベースである。道路データには、経路探索用の車道／車線ネットワークデータ、道路形状データ、交通法規データなどが含まれる。地物データは、道路標識等の看板や停止線等の道路標示、白線等の道路区画線や道路沿いの構造物等の情報（例えば位置情報及び種別情報）を含む。また、地物データは、自車位置推定に用いるための地物の高精度な点群情報（例えば３次元地図をボクセルごとの正規分布により近似したボクセルデータ）などを含んでもよい。障害物データには、道路工事、駐車/停車車両、道路上の落下物等に関する位置情報や種別情報を含む。その他、地図ＤＢ１０には、位置推定に必要な種々のデータが記憶されてもよい。
【００３５】
ライダ設置情報ＩＬは、ある基準時（例えばライダ２のアライメント調整直後などの姿勢ずれが生じていない時）におけるライダ２の車両に対する相対的な姿勢及び位置に関する情報である。本実施例では、ライダ２等の姿勢を、ロール角、ピッチ角、ヨー角（即ちオイラー角）により表すものとする。ライダ設置情報ＩＬは、後述するライダ２の姿勢の推定処理が実行された場合に、推定結果に基づき更新されてもよい。
【００３６】
通信部１３は、制御部１５の制御に基づき、アップロード情報Ｉｕをサーバ装置６に送信したり、ダウンロード情報Ｉｄをサーバ装置６から受信したりする。入力部１４は、ユーザが操作するためのボタン、タッチパネル、リモートコントローラ、音声入力装置等であり、経路探索のための目的地を指定する入力、自動運転のオン及びオフを指定する入力などを受け付ける。情報出力部１６は、例えば、制御部１５の制御に基づき出力を行うディスプレイやスピーカ等である。
【００３７】
制御部１５は、プログラムを実行するＣＰＵなどを含み、車載機１の全体を制御する。本実施例では、制御部１５は、自車位置推定部１７と、運転支援制御部１８と、ライダ位置姿勢推定部１９と、アップロード制御部２０と、地図更新部２１と、を有する。制御部１５は、プログラムを実行するコンピュータとして機能する。
【００３８】
自車位置推定部１７は、インターフェース１１から供給されるセンサ群９の出力信号及び地図ＤＢ１０に基づき、自車位置の推定を行う。自車位置推定部１７は、任意の自車位置の推定方法を適用して自車位置の推定を行ってもよい。例えば、自車位置推定部１７は、自車位置推定として、ライダ２による特定の地物の計測結果と、地図ＤＢ１０の地物データに記録された計測対象の地物の位置情報とを用いた位置推定（所謂ランドマーク位置推定）、ボクセルデータを用いたＮＤＴ（Ｎｏｒｍａｌ  Ｄｉｓｔｒｉｂｕｔｉｏｎｓ  Ｔｒａｎｓｆｏｒｍ）スキャンマッチングによる位置推定、又はＧＰＳ受信機５等を用いた全球測位衛星システム（ＧＮＳＳ：Ｇｌｏｂａｌ  Ｎａｖｉｇａｔｉｏｎ  Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍ)による位置推定などを行う。
【００３９】
さらに、自車位置推定部１７は、自車位置の推定処理において、推定した自車位置の推定精度（「推定自車位置精度」とも呼ぶ。）に関する情報を生成する。例えば、自車位置推定部１７は、特許文献２等に示されるカルマンフィルタを用いた自車位置推定を行った場合、推定位置の誤差分布に相当する共分散行列の対角要素の平方根を推定自車位置精度として認識する。他の例では、自車位置推定部１７は、ボクセルデータを用いたＮＤＴスキャンマッチングによる位置推定を行う場合、ライダの計測点群とボクセルデータとの一致度を示す評価関数に基づき推定自車位置精度を設定する。さらに別の例では、自車位置推定部１７は、ＧＮＳＳによる位置推定を行った場合には、ＧＰＳ受信機５から得られるＤＯＰ（Ｄｉｌｕｔｉｏｎ  Ｏｆ  Ｐｒｅｃｉｓｉｏｎ）を推定自車位置精度として取得する。また、自車位置推定部１７は、ＧＮＳＳによる位置推定を行った場合、所定時間内にＧＰＳ受信機５から取得した緯度、経度、高度の各々の標準偏差の値を、推定自車位置精度として取得してもよい。
【００４０】
運転支援制御部１８は、自車位置の推定結果に基づいて自動運転制御を含む車両の運転支援に関する制御を行う。このとき、運転支援制御部１８は、ライダ２の出力データを用いる場合には、ライダ２が出力する計測データを、ライダ設置情報ＩＬに記録されたライダ２の姿勢及び位置を基準として、ライダ２を基準とした座標系から車両を基準とした座標系に変換する。これにより、運転支援制御部１８は、ライダ２により計測される障害物等の車両に対する相対位置を的確に把握して車両の制御や警告などを行う。
【００４１】
ライダ位置姿勢推定部１９は、車両に対するライダ２の現在（即ち処理基準時）の位置又は／及び姿勢（単に「位置姿勢」とも呼ぶ。）を推定することで、ライダ設置情報ＩＬに記録された位置姿勢に対する変化量（「ライダ位置姿勢変化量」とも呼ぶ。）を算出する。車両に対するライダ２の位置姿勢の推定方法は、任意の方法であってもよい。例えば、ライダ２の位置姿勢を検知するための１又は複数のセンサ（例えば変位センサや加速度センサ）がライダ２に設けられている場合には、ライダ位置姿勢推定部１９は、当該センサの出力に基づき、ライダ２の位置姿勢を検出し、ライダ設置情報ＩＬに記録されたライダ２の位置姿勢との差分をライダ位置姿勢変化量として算出する。他の例では、ライダ位置姿勢推定部１９は、３台以上のライダ２が存在する場合には、これらのライダの計測結果を比較することで、位置姿勢のずれが発生しているライダの特定及び当該ライダの位置姿勢のずれ量（即ちライダ位置姿勢変化量）の算出を行う。さらに別の例では、ライダ位置姿勢推定部１９は、走行路に沿った白線などの区画線、走行路の進行方向に対して垂直面を有する道路標識、走行路の幅方向に対して垂直面を有する道路標識などをライダ２により計測し、その計測結果に基づきライダ位置姿勢変化量を検出してもよい。
【００４２】
また、ライダ位置姿勢推定部１９は、ライダ２の位置姿勢の推定を行った場合、推定した位置姿勢の精度（「ライダ位置姿勢推定精度」とも呼ぶ。）を算出する。例えば、ライダ位置姿勢推定部１９は、実行可能なライダ２の位置姿勢の推定手法ごとにライダ位置姿勢精度の値を対応付けたテーブル等を記憶しておき、当該テーブルを参照することで、推定したライダ２の位置姿勢に対するライダ位置姿勢推定精度を決定する。他の例では、ライダ位置姿勢推定部１９は、ライダ２の位置姿勢の推定において使用したセンサの種別情報又は性能に関する情報等に基づき、所定のテーブル等を参照することで、ライダ位置姿勢推定精度を決定してもよい。
【００４３】
アップロード制御部２０は、ライダ２の出力に基づき所定のオブジェクトを検出した場合などに、検出したオブジェクトに関する情報（「オブジェクト情報」とも呼ぶ。）を含むアップロード情報Ｉｕを生成し、アップロード情報Ｉｕをサーバ装置６へ送信する。上述のオブジェクト情報は、少なくともオブジェクトの位置情報（本実施例では、ライダ２による計測値の情報）を含むものであり、オブジェクトの識別情報、オブジェクトの形状、大きさなどのオブジェクトの属性情報がさらに含まれてもよい。また、本実施例では、アップロード制御部２０は、オブジェクト情報に加えて、検出に用いたライダ２の位置姿勢に関する情報（「ライダ位置姿勢情報」とも呼ぶ。）と、自車位置推定部１７が推定した自車位置に関する情報（「自車位置姿勢情報」とも呼ぶ。）と、オブジェクト情報に含まれる計測値の絶対座標系（ワールド座標系）への変換の有無を示すフラグ情報（「座標変換フラグ」とも呼ぶ。）と、をアップロード情報Ｉｕに含める。このアップロード情報Ｉｕのデータ構造については、［アップロード情報のデータ構造］のセクションで詳しく説明する。
【００４４】
地図更新部２１は、サーバ装置６から通信部１３がダウンロード情報Ｉｄを受信した場合に、当該ダウンロード情報Ｉｄを用いて地図ＤＢ１０の更新を行う。
【００４５】
［サーバ装置の構成］
図２（Ｂ）は、サーバ装置６の機能的構成を示すブロック図である。サーバ装置６は、主に、通信部６１と、記憶部６２と、制御部６５とを備える。これらの各要素は、バスラインを介して相互に接続されている。
【００４６】
通信部６１は、制御部６５の制御に基づき、アップロード情報Ｉｕを車載機１から受信したり、ダウンロード情報Ｉｄを車載機１へ送信したりする。記憶部６２は、制御部６５が実行するプログラムや、制御部６５が所定の処理を実行するのに必要な情報を記憶する。本実施例では、記憶部６２は、地図ＤＢ１０と同様のデータ構造を有する配信地図ＤＢ２２と、各車載機１から受信したアップロード情報Ｉｕのデータベースであるアップロード情報ＤＢ２７と、を記憶する。
【００４７】
制御部６５は、プログラムを実行するＣＰＵなどを含み、サーバ装置６の全体を制御する。本実施例では、制御部６５は、アップロード情報ＤＢ２７に含まれるオブジェクト情報等に基づき配信地図ＤＢ２２を更新する処理及び当該更新処理により生成した地図更新情報を含むダウンロード情報Ｉｄを通信部６１により各車載機１へ送信する処理などを行う。制御部６５は、プログラムを実行するコンピュータとして機能する。
【００４８】
［座標系の変換］
ライダ２により取得される３次元点群データの各計測点が示す３次元座標は、ライダ２の位置姿勢を基準とした座標系（「ライダ座標系」とも呼ぶ。）で表されている。よって、ライダ２の計測値を地図に反映させる場合、車両の位置姿勢を基準とした座標系（「車両座標系」とも呼ぶ。）に変換した後、ライダ２の計測値を地図において採用されているワールド座標系（絶対座標系）に変換させる必要がある。
【００４９】
ここで、ライダ座標系での計測値［ｘＬ（ｉ）、ｙＬ（ｉ）、ｚＬ（ｉ）］Ｔは、ライダ２の位置姿勢にずれが生じていない時の車両座標系におけるライダ２の位置姿勢［Ｌｘ０、Ｌｙ０、Ｌｚ０、Ｌφ０、Ｌθ０、Ｌψ０］Ｔを用いた以下の式（１）により、車両座標系の座標値［ｘＢ（ｉ）、ｙＢ（ｉ）、ｚＢ（ｉ）］Ｔに変換される。
【００５０】
【数１】
2020046413.tif 000003
「Ｌｘ０」、「Ｌｙ０」、「Ｌｚ０」は、それぞれ、車両座標系におけるライダ２の位置を示し、「Ｌφ０」、「Ｌθ０」、「Ｌψ０」は、それぞれ、車両座標系に対するライダ２のロール角、ピッチ角、ヨー角を示す。なお、ライダ２の位置姿勢［Ｌｘ０、Ｌｙ０、Ｌｚ０、Ｌφ０、Ｌθ０、Ｌψ０］Ｔは、例えばライダ設置情報ＩＬに予め記録されており、「基準取付位置姿勢」の一例である。また、ライダ座標系は、「計測装置の位置を基準とした座標系」の一例である。
【００５１】
ここで、ライダ２の位置姿勢にずれが生じ、その変化量が［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔであった場合、現在のライダ２の位置姿勢［Ｌｘ、Ｌｙ、Ｌｚ、Ｌφ、Ｌθ、Ｌψ］Ｔは、以下の式（２）により表される。
【００５２】
【数２】
2020046413.tif 000004
この場合、ライダ座標系での計測値［ｘＬ（ｉ）、ｙＬ（ｉ）、ｚＬ（ｉ）］Ｔは、現在のライダ２の位置姿勢［Ｌｘ、Ｌｙ、Ｌｚ、Ｌφ、Ｌθ、Ｌψ］を用いて、式（１）と同様の以下の式（３）により、車両座標系の座標値［ｘＢ（ｉ）、ｙＢ（ｉ）、ｚＢ（ｉ）］Ｔに変換することができる。
【００５３】
【数３】
2020046413.tif 000005
次に、時刻「ｋ」における自車位置（姿勢を含む）の推定値（「推定自車位置」とも呼ぶ。）を［Ｂ＾ｘ（ｋ）、Ｂ＾ｙ（ｋ）、Ｂ＾ｚ（ｋ）、Ｂ＾φ（ｋ）、Ｂ＾θ（ｋ）、Ｂ＾ψ（ｋ）］Ｔとすると、車両座標系の座標値［ｘＢ（ｉ）、ｙＢ（ｉ）、ｚＢ（ｉ）］Ｔは、以下の式（４）に基づき、ワールド座標系の座標値［ｘＷ（ｉ）、ｙＷ（ｉ）、ｚＷ（ｉ）］Ｔに変換される。
【００５４】
【数４】
2020046413.tif 000006
従って、車載機１又はサーバ装置６は、ライダ座標系での計測値［ｘＬ（ｉ）、ｙＬ（ｉ）、ｚＬ（ｉ）］Ｔを得た場合、まず、ライダ２の位置姿勢の情報に基づき、式（３）を用いて車両座標系の座標値［ｘＢ（ｉ）、ｙＢ（ｉ）、ｚＢ（ｉ）］Ｔに変換する。そして、車載機１又はサーバ装置６は、推定自車位置の情報を用いて、式（４）に基づき車両座標系の座標値をワールド座標系の座標値［ｘＷ（ｉ）、ｙＷ（ｉ）、ｚＷ（ｉ）］Ｔに変換する。これにより、地図と同一の座標系で表されたライダ２の計測値を好適に取得することができ、地図更新に好適に用いることができる。
【００５５】
ここで、ライダ座標系から車両座標系の変換について補足説明する。
【００５６】
図３は、２次元座標により表された車両座標系とライダ座標系との関係を示す図である。ここでは、車両座標系は、車両の中心を原点とし、車両の進行方向に沿った座標軸「ＸＢ」と車両の側面方向に沿った座標軸「ＹＢ」を有する。また、ライダ座標系は、ライダ２の正面方向（矢印Ａ２参照）に沿った座標軸「ＸＬ」とライダ２の側面方向に沿った座標軸「ＹＬ」を有する。
【００５７】
ここで、車両座標系に対するライダ２のヨー角を「Ｌψ０」、ライダ２の位置を［Ｌｘ０、Ｌｙ０］Ｔとした場合、車両座標系から見た時刻ｉの計測点［ｘＢ（ｉ）、ｙＢ（ｉ）］Ｔは、回転行列「ＣＬψ０」を用いた以下の式（５）によりライダ座標系の座標［ｘＬ（ｉ）、ｙＬ（ｉ）］Ｔへ変換される。
【００５８】
【数５】
2020046413.tif 000007
【００５９】
一方、ライダ座標系から車両座標系への変換は、回転行列の逆行列（転置行列）を用いればよい。よって、ライダ座標系で取得した時刻ｉの計測点［ｘＬ（ｉ）、ｙＬ（ｉ）］Ｔは、以下の式（６）により車両座標系の座標［ｘＢ（ｉ）、ｙＢ（ｉ）］Ｔに変換することが可能である。
【００６０】
【数６】
2020046413.tif 000008
【００６１】
図４は、３次元座標により表された車両座標系とライダ座標系との関係を示す図である。
【００６２】
この場合、車両座標系から見た時刻ｉの計測点［ｘＢ（ｉ）、ｙＢ（ｉ）、ｚＢ（ｉ）］Ｔは、車両座標系に対するライダ２の位置姿勢［Ｌｘ０、Ｌｙ０、Ｌｚ０、Ｌφ０、Ｌθ０、Ｌψ０］Ｔと、ロール、ピッチ、ヨーに対応する各回転行列「ＣＬφ０」、「ＣＬθ０」、「ＣＬψ０」により表される方向余弦行列「ＣＬ０」とを用いた以下の式（７）により、ライダ座標系の座標［ｘＬ（ｉ）、ｙＬ（ｉ）、ｚＬ（ｉ）］Ｔへ変換される。
【００６３】
【数７】
2020046413.tif 000009
一方、ライダ座標系から車両座標系への変換は、方向余弦行列ＣＬ０の逆行列（転置行列）を用いればよい。よって、ライダ座標系で取得した時刻ｉの計測点［ｘＬ（ｉ）、ｙＬ（ｉ）、ｚＬ（ｉ）］Ｔは、以下の式（８）により車両座標系の座標［ｘＢ（ｉ）、ｙＢ（ｉ）、ｚＢ（ｉ）］Ｔに変換することが可能である。
【００６４】
【数８】
2020046413.tif 000010
この式（８）は、式（１）と等価の式となる。
【００６５】
次に、車両座標系からワールド座標系の変換について補足説明する。
【００６６】
図５は、２次元座標により表された車両座標系とワールド座標系との関係を示す図である。ここでは、ワールド座標系は、座標軸「ＸＷ」と座標軸「ＹＷ」を有する。
【００６７】
ワールド座標系に対する時刻ｋの車両のヨー角の推定値がＢ＾ψ（ｋ）であり，車両の推定位置がＢ＾ｘ（ｋ）、Ｂ＾ｙ（ｋ）であった場合，ワールド座標系から見た点群データの車両座標系への変換は、回転行列「ＣＢψ（ｋ）」を用いた以下の式（９）により計算できる。
【００６８】
【数９】
2020046413.tif 000011
【００６９】
一方、ライダ座標系から車両座標系への変換は、回転行列ＣＢψ（ｋ）の逆行列（転置行列）を用いればよい。よって、［ｘＢ（ｉ）、ｙＢ（ｉ）］Ｔは、以下の式（１０）によりワールド座標系の座標［ｘＷ（ｉ）、ｙＷ（ｉ）］Ｔに変換することが可能である。
【００７０】
【数１０】
2020046413.tif 000012
【００７１】
次に、３次元座標により表された車両座標系とワールド座標系との関係について説明する。
【００７２】
この場合、ワールド座標系から見た時刻ｉの座標値［ｘＷ（ｉ）、ｙＷ（ｉ）、ｚＷ（ｉ）］Ｔは、時刻ｋにおける自車位置（姿勢を含む）の推定値［Ｂ＾ｘ（ｋ）、Ｂ＾ｙ（ｋ）、Ｂ＾ｚ（ｋ）、Ｂ＾φ（ｋ）、Ｂ＾θ（ｋ）、Ｂ＾ψ（ｋ）］Ｔと、ロール、ピッチ、ヨーに対応する各回転行列「ＣＢφ（ｋ）」、「ＣＢθ（ｋ）」、「ＣＢψ（ｋ）」により表される方向余弦行列「ＣＢ（ｋ）」とを用いた以下の式（１１）により、車両座標系の座標［ｘＢ（ｉ）、ｙＢ（ｉ）、ｚＢ（ｉ）］Ｔへ変換される。
【００７３】
【数１１】
2020046413.tif 000013
【００７４】
一方、車両座標系からワールド座標系への変換は、方向余弦行列ＣＢ（ｋ）の逆行列（転置行列）を用いればよい。よって、車両座標系で取得した時刻ｉの計測点［ｘＢ（ｉ）、ｙＢ（ｉ）、ｚＢ（ｉ）］Ｔは、以下の式（１２）によりワールド座標系の座標［ｘＷ（ｉ）、ｙＷ（ｉ）、ｚＷ（ｉ）］Ｔに変換することが可能である。
【００７５】
【数１２】
2020046413.tif 000014
この式（１２）は、式（４）と等価の式となる。
【００７６】
［アップロード情報のデータ構造］
図６は、アップロード情報Ｉｕのデータ構造の一例を示す。図６の例では、アップロード情報Ｉｕは、「時刻」、「ライダ番号」、「計測値」、「ライダ位置姿勢」、「ライダ位置姿勢変化量」、「ライダ位置姿勢推定精度」、「座標変換フラグ」、「推定自車位置」、「推定自車位置精度」と、を含んでいる。なお、「計測値」は上述したオブジェクト情報に該当し、「ライダ位置姿勢」及び「ライダ位置姿勢変化量」及び「ライダ位置姿勢推定精度」は、上述したライダ位置姿勢情報に該当し、「推定自車位置」及び「推定自車位置精度」は、上述した自車位置姿勢情報に該当する。
【００７７】
車載機１は、「時刻」として、ライダ２による計測を行った時刻又はアップロード情報Ｉｕの送信時刻を指定する。また、車載機１は、「ライダ番号」として、車両に複数のライダ２が搭載されている場合に各ライダ２を識別するための番号を指定する。また、車載機１は、「計測値」として、ライダ２により計測したオブジェクトの計測点群が示すＮ（Ｎは１以上の整数）個の計測値［ｘｉ、ｙｉ、ｚｉ］Ｔを指定する。なお、この計測値［ｘｉ、ｙｉ、ｚｉ］Ｔは、ライダ座標系の座標値であってもよく、ワールド座標系の座標値であってもよい。
【００７８】
また、車載機１は、「ライダ位置姿勢」として、車両座標系のライダ２の位置姿勢を指定する。この場合、「ライダ位置姿勢」は、ライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔを加味した現在のライダ２の位置姿勢［Ｌｘ、Ｌｙ、Ｌｚ、Ｌφ、Ｌθ、Ｌψ］であってもよく、ライダ設置情報ＩＬに記録されたライダ２の位置姿勢［Ｌｘ０、Ｌｙ０、Ｌｚ０、Ｌφ０、Ｌθ０、Ｌψ０］Ｔ（即ちライダ２の位置姿勢にずれが生じていない時のライダ２の位置姿勢）であってもよい。後者の場合であっても、アップロード情報Ｉｕを受信したサーバ装置６は、後述する「ライダ位置姿勢変化量」を用いて式（２）に基づき現在のライダ２の位置姿勢［Ｌｘ、Ｌｙ、Ｌｚ、Ｌφ、Ｌθ、Ｌψ］を特定することが可能である。
【００７９】
また、車載機１は、「ライダ位置姿勢変化量」として、ライダ位置姿勢推定部１９が算出したライダ２の位置姿勢の変化量であるライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔを指定する。また、車載機１は、「ライダ位置姿勢推定精度」として、推定したライダ位置姿勢変化量又は現在のライダ２の位置姿勢に対する推定精度であるライダ位置姿勢推定精度「σＬｘ、σＬｙ、σＬｚ、σＬφ、σＬθ、σＬψ」Ｔを指定する。ライダ位置姿勢推定精度「σＬｘ、σＬｙ、σＬｚ、σＬφ、σＬθ、σＬψ」Ｔは、ライダ位置姿勢推定部１９により算出される。
【００８０】
また、車載機１は、「座標変換フラグ」として、「計測値」に指定したライダ２の計測値［ｘｉ、ｙｉ、ｚｉ］Ｔが車両座標系あるいはワールド座標系に変換されたものであるか否かを示す情報を指定する。本実施形態では、一例として、車載機１は、ライダ２の計測値［ｘｉ、ｙｉ、ｚｉ］Ｔがワールド座標系に変換されたものである場合には、座標変換フラグを「２」に設定し、ライダ２の計測値［ｘｉ、ｙｉ、ｚｉ］Ｔが車両座標系に変換されたものである場合には、座標変換フラグを「１」に設定し、ライダ２の計測値［ｘｉ、ｙｉ、ｚｉ］Ｔが車両座標系にもワールド座標系にも変換されていないもの（即ちライダ座標系のまま）である場合には、座標変換フラグを「０」に設定するものとする。このように、座標変換フラグは、ライダ２の計測値がライダ座標系で示されているか否かを示す座標系情報、及び、ライダ座標系から異なる座標系（ここでは車両座標系あるいはワールド座標系）に変換されたか否かを示す座標系情報に相当する。
【００８１】
また、車載機１は、「推定自車位置」として、ライダ２の計測時に自車位置推定部１７が推定した推定自車位置［Ｂ＾ｘ、Ｂ＾ｙ、Ｂ＾ｚ、Ｂ＾φ、Ｂ＾θ、Ｂ＾ψ］Ｔを指定する。ここで、Ｂ＾ｘ、Ｂ＾ｙ、Ｂ＾ｚは自車の位置、Ｂ＾φ、Ｂ＾θ、Ｂ＾ψは自車の姿勢を示す。また、車載機１は、「推定自車位置精度」として、ライダ２の計測時に自車位置推定部１７が推定した自車位置の精度である推定自車位置精度「σＢｘ、σＢｙ、σＢｚ、σＢφ、σＢθ、σＢψ」Ｔを指定する。
【００８２】
なお、アップロード情報Ｉｕには、上述した各項目以外の任意の情報が含まれてもよい。例えば、アップロード情報Ｉｕには、計測対象となった地物を特定するための地物の識別情報（地物ＩＤ）などが含まれてもよい。
【００８３】
［アップロード処理］
次に、アップロード情報Ｉｕの生成及び送信を含むアップロード処理について説明する。図７は、車載機１が実行するアップロード処理の手順を示すフローチャートである。車載機１は、図７のフローチャートの処理を、ライダ２の出力に基づき所定のオブジェクトを検出した場合などに実行する。
【００８４】
まず、車載機１のライダ位置姿勢推定部１９は、ライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔを算出する（ステップＳ１０１）。また、ライダ位置姿勢推定部１９は、ライダ位置姿勢推定精度「σＬｘ、σＬｙ、σＬｚ、σＬφ、σＬθ、σＬψ」Ｔを算出する（ステップＳ１０２）。
【００８５】
また、車載機１の自車位置推定部１７は、地図ＤＢ１０に含まれる地物の位置情報等と、当該地物のライダ２による計測値とに基づき、自車位置推定を行う（ステップＳ１０３）。ステップＳ１０３での自車位置推定方法は、ランドマーク位置推定、ＮＤＴスキャンマッチングによる位置推定などの任意の位置推定方法であってもよい。これにより、自車位置推定部１７は、推定自車位置［Ｂ＾ｘ、Ｂ＾ｙ、Ｂ＾ｚ、Ｂ＾φ、Ｂ＾θ、Ｂ＾ψ］Ｔを算出する。また、自車位置推定部１７は、、地図ＤＢ１０及びライダ２の計測値を使用する代わりに、ＧＰＳ受信機５の出力を用いた位置推定（所謂ＧＮＳＳによる位置推定）を行ってもよい。さらに、自車位置推定部１７は、ステップＳ１０３での位置推定の推定精度である推定自車位置精度「σＢｘ、σＢｙ、σＢｚ、σＢφ、σＢθ、σＢψ」Ｔを算出する（ステップＳ１０４）。
【００８６】
そして、車載機１のアップロード制御部２０は、ライダ２の計測値を車両座標系に変換するか否か判定する（ステップＳ１０５）。この場合、例えば、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換するか否かに関する設定情報を予め記憶している場合には、当該設定情報に基づき、上述の判定を行う。上述の設定情報は、ユーザ入力に基づき生成されてもよい。
【００８７】
そして、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換すべきと判断した場合（ステップＳ１０５；Ｙｅｓ）、ステップＳ１０１で算出したライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔを加味した現在のライダ位置姿勢［Ｌｘ、Ｌｙ、Ｌｚ、Ｌφ、Ｌθ、Ｌψ］Ｔに基づき、式（３）により車両座標系の計測値［ｘＢ、ｙＢ、ｚＢ］Ｔを算出する（ステップＳ１０６）。
【００８８】
一方、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換すべきでない場合（ステップＳ１０５；Ｎｏ）、座標変換フラグを「０」に設定する（ステップＳ１１０）。
【００８９】
そして、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換した値をワールド座標系に変換するか否か判定する（ステップＳ１０７）。この場合、例えば、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換した値をワールド座標系に変換するか否かに関する設定情報を予め記憶している場合には、当該設定情報に基づき、上述の判定を行う。上述の設定情報は、ユーザ入力に基づき生成されてもよい。
【００９０】
そして、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換した値をワールド座標系に変換すべきと判断した場合（ステップＳ１０７；Ｙｅｓ）、座標変換フラグを「２」に設定する（ステップＳ１０８）。そして、この場合、アップロード制御部２０は、ステップＳ１０３で算出した推定自車位置［Ｂ＾ｘ、Ｂ＾ｙ、Ｂ＾ｚ、Ｂ＾φ、Ｂ＾θ、Ｂ＾ψ］Ｔに基づき、式（４）により、ワールド座標系の計測値［ｘＷ（ｉ）、ｙＷ（ｉ）、ｚＷ（ｉ）］Ｔを算出する（ステップＳ１１１）。
【００９１】
一方、アップロード制御部２０は、ライダ２の計測値を車両座標系に変換した値をワールド座標系に変換すべきでない場合（ステップＳ１０７；Ｎｏ）、座標変換フラグを「１」に設定する（ステップＳ１０９）。
【００９２】
ステップＳ１０９、ステップＳ１１０、又はステップＳ１１１のいずれかの実行後、アップロード制御部２０は、図６に示す「時刻」、「ライダ番号」、「計測値」、「ライダ位置姿勢」、「ライダ位置姿勢変化量」、「ライダ位置姿勢推定精度」、「座標変換フラグ」、「推定自車位置」、「推定自車位置精度」の各項目に該当する情報を含むアップロード情報Ｉｕを生成し、当該アップロード情報Ｉｕをサーバ装置６へ送信する（ステップＳ１１２）。これにより、車載機１は、ライダ２の計測値に基づきサーバ装置６が地図を更新するのに必要な情報を好適にサーバ装置６に送信することができる。尚、「計測値」はライダ２の計測値またはライダ２の計測値を車両座標系に変換した値である。
【００９３】
［地図更新処理］
次に、受信したアップロード情報Ｉｕに基づき地図ＤＢ１０及び配信地図ＤＢ２２の更新情報を生成する処理である地図更新処理について説明する。図８は、サーバ装置６が実行する地図更新処理のフローチャートである。サーバ装置６は、図８に示すフローチャートの処理を繰り返し実行する。
【００９４】
まず、サーバ装置６は、各車両の車載機１から送信されるアップロード情報Ｉｕを受信することでアップロード情報Ｉｕを収集する（ステップＳ２０１）。そして、サーバ装置６は、受信したアップロード情報Ｉｕをアップロード情報ＤＢ２７に記憶する。
【００９５】
そして、サーバ装置６は、地図更新を行う所定のタイミングにおいて、アップロード情報ＤＢ２７に記録されたアップロード情報Ｉｕの各々の座標変換フラグを参照し、座標変換フラグが０または１となるアップロード情報Ｉｕの存在の有無を判定する。そして、サーバ装置６は、座標変換フラグが０であるアップロード情報Ｉｕが存在する場合には、当該アップロード情報Ｉｕに含まれるライダ位置姿勢、ライダ位置姿勢変化量、及び推定自車位置から、当該アップロード情報Ｉｕに含まれるライダ２の計測値をワールド座標系に変換する。一方、座標変換フラグが１であるアップロード情報Ｉｕが存在する場合には、サーバ装置６は、当該アップロード情報Ｉｕに含まれる推定自車位置から、当該アップロード情報Ｉｕに含まれるライダ２の計測値を車両座標系に変換した値をワールド座標系に変換する（ステップＳ２０２）。これにより、サーバ装置６は、アップロード情報Ｉｕにライダ座標系の計測値や車両座標系の計測値が含まれる場合であっても、地図において採用されるワールド座標系の座標値にライダ２の計測値やライダ２の計測値を車両座標系に変換した値を好適に変換することができる。
【００９６】
次に、サーバ装置６は、ライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔの各要素のうちいずれかが所定の閾値（「第１閾値」とも呼ぶ。）以上となるものが存在するか否か判定する。さらに、サーバ装置６は、ライダ位置姿勢推定精度「σＬｘ、σＬｙ、σＬｚ、σＬφ、σＬθ、σＬψ」Ｔの各要素のうちいずれかが所定の閾値（「第２閾値」とも呼ぶ。）以上となるものが存在するか否か判定する。これに加えて、サーバ装置６は、推定自車位置精度「σＢｘ、σＢｙ、σＢｚ、σＢφ、σＢθ、σＢψ」Ｔの各要素のうちいずれかが所定の閾値（「第３閾値」とも呼ぶ。）以上となるものが存在するか否か判定する（ステップＳ２０３）。第１〜第３閾値は、ライダ２の計測値の精度が地図更新に使用できる程度の精度を有するか否かを判定するための閾値である。第１〜第３閾値は、比較対象の要素ごとにそれぞれ適切な値となるように比較対象の要素ごとに異なる値に設定されてもよい。なお、ここでは、ライダ位置姿勢推定精度「σＬｘ、σＬｙ、σＬｚ、σＬφ、σＬθ、σＬψ」Ｔ及び推定自車位置精度「σＢｘ、σＢｙ、σＢｚ、σＢφ、σＢθ、σＢψ」Ｔの各要素は、例えば標準偏差等の値であり、いずれも、低い値ほど精度が高いことを示すものとする。
【００９７】
そして、サーバ装置６は、ライダ位置姿勢変化量の各要素のうちいずれかが第１閾値以上となるものが存在する場合、又は、ライダ位置姿勢推定精度の各要素のうちいずれかが第２閾値以上となるものが存在する場合、若しくは、推定自車位置精度の各要素のうちいずれかが第３閾値以上となるものが存在する場合（ステップＳ２０３；Ｙｅｓ）、対象のアップロード情報Ｉｕに含まれるライダ２の計測値の精度が低く、地図更新に用いるほどの信頼性がないと判断する。よって、この場合、サーバ装置６は、対象のアップロード情報Ｉｕに含まれる計測値を後述するステップＳ２０６の平均処理において使用しない、又は、平均処理における重み付け値を０に設定する（ステップＳ２０５）。これにより、サーバ装置６は、事故等に起因してライダ位置姿勢変化量が大きくなったライダ２の計測値、ライダ位置姿勢推定精度が低いライダ位置姿勢に基づき座標変換がなされたライダ２の計測値、及び、推定自車位置精度が低い推定自車位置に基づき座標変換がなされたライダ２の計測値などを地図更新において使用するのを好適に抑制することができる。
【００９８】
一方、サーバ装置６は、ライダ位置姿勢変化量の各要素がいずれも第１閾値未満となり、かつ、ライダ位置姿勢推定精度の各要素がいずれも第２閾値未満となり、かつ、推定自車位置精度の各要素のいずれもが第３閾値未満となる場合（ステップＳ２０３；Ｎｏ）、対象のアップロード情報Ｉｕに含まれるライダ２の計測値の精度が地図更新に用いることができる程度に高いと判断する。よって、この場合、サーバ装置６は、ライダ位置姿勢変化量、ライダ位置姿勢推定精度、及び推定自車位置精度に応じて、対象のアップロード情報Ｉｕに含まれるライダ２の計測値に対する重み付け値を設定する（ステップＳ２０４）。この場合、例えば、サーバ装置６は、ライダ位置姿勢変化量、ライダ位置姿勢推定精度、及び推定自車位置精度の各要素から重み付け値を決定するための式又はマップを参照することで、上述の重み付け値を設定する。この場合、サーバ装置６は、ライダ位置姿勢変化量が小さいほど上述の重み付け値を大きくし、ライダ位置姿勢推定精度が小さいほど上述の重み付け値を大きくし、推定自車位置精度が小さいほど上述の重み付け値を大きくするように、上述の重み付け値を決定する。これにより、サーバ装置６は、地図更新に用いるライダ２の計測値の各々に対し、その計測値の精度に応じた適切な重み付け値を好適に設定することができる。
【００９９】
次に、サーバ装置６は、各計測値に対して、ステップＳ２０４又はステップＳ２０５で設定した重み付け値による重み付け平均処理を行うことで、統合データを生成する（ステップＳ２０６）。統合データは、例えば、各計測値を統計処理することで算出した地物の位置情報などが該当する。このように、サーバ装置６は、計測値の信頼度（精度）に応じて設定した重み付け値を用いることで、高精度な統合データを生成することができる。ステップＳ２０６の具体例については後述する。そして、サーバ装置６は、ステップＳ２０６で生成した統合データを用いて配信地図ＤＢ２２を更新する（ステップＳ２０７）。その後、サーバ装置６は、生成した統合データを含むダウンロード情報Ｉｄを各車載機１へ送信する。
【０１００】
ここで、ステップＳ２０６の処理の具体例について説明する。ここでは、統合データとして、配信地図ＤＢ２２に登録するオブジェクト（地物）の絶対位置（「オブジェクト推定位置」とも呼ぶ。）を算出する例について説明する。なお、サーバ装置６は、この場合、例えば、アップロード情報Ｉｕに含まれるライダ２の計測値をオブジェクトごとに分類し、オブジェクトごとにオブジェクト推定位置を算出する。この場合、サーバ装置６は、配信地図ＤＢ２２に登録された各オブジェクトの位置情報に基づき計測値をオブジェクトごとに分類してもよく、公知のクラスタリング技術に基づき上述の分類を行ってもよく、ユーザ入力に基づき上述の分類を行ってもよい。また、車載機１がライダ２により計測したオブジェクトごとにアップロード情報Ｉｕを生成し、計測したオブジェクトの識別情報をアップロード情報Ｉｕに含めている場合には、サーバ装置６は、当該識別情報に基づき、上述の分類を行ってもよい。
【０１０１】
ここで、各アップロード情報Ｉｕにより示されるワールド座標系のオブジェクトの計測値を［ｐｘ、ｐｙ、ｐｚ］Ｔとし、ステップＳ２０４又はステップＳ２０５で設定した重み付け値を［ｗｘ（ｋ）、ｗｙ（ｋ）、ｗｚ（ｋ）］Ｔとする。そして、サーバ装置６は、複数の車両からそれぞれ複数の時刻のｍ個のアップロード情報Ｉｕを受信した場合，以下の式（１３）〜式（１５）が示す重み付け平均処理により、配信地図ＤＢ２２に反映すべきオブジェクトの位置［ｐ＾ｘ、ｐ＾ｙ、ｐ＾ｚ］Ｔを算出する。
【０１０２】
【数１３】
2020046413.tif 000015
【０１０３】
【数１４】
2020046413.tif 000016
【０１０４】
【数１５】
2020046413.tif 000017
このように、サーバ装置６は、重み付け平均処理により、配信地図ＤＢ２２に反映すべきオブジェクトの位置を好適に算出することができる。
【０１０５】
以上説明したように、本実施例に係るアップロード情報Ｉｕのデータ構造は、車両に取り付けられたライダ２が計測した物体を示す計測値［ｘｉ、ｙｉ、ｚｉ］Ｔと、ライダ２が物体を計測した際の、ライダ２の車両への基準取付姿勢に対する車両への取付姿勢の変化量であるライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔとを有する。そして、このアップロード情報Ｉｕは、ライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔに基づき、計測値［ｘｉ、ｙｉ、ｚｉ］Ｔの座標系をワールド座標系に変換するサーバ装置６に送信される。
【０１０６】
また、以上説明したように、本実施例に係るアップロード情報Ｉｕのデータ構造は、車両に取り付けられたライダ２が計測した物体を示す計測値［ｘｉ、ｙｉ、ｚｉ］Ｔと、当該計測値［ｘｉ、ｙｉ、ｚｉ］Ｔが、ライダ２の位置を基準としたライダ座標系で示されているか否か（言い換えると、ライダ座標系から車両座標系あるいはワールド座標系に変換されたか否か）を示す座標変換フラグとを有する。そして、このアップロード情報Ｉｕは、座標変換フラグに基づき、計測値［ｘｉ、ｙｉ、ｚｉ］Ｔの座標系をワールド座標系に変換するサーバ装置６に送信される。
【０１０７】
［変形例］
以下、実施例に好適な変形例について説明する。以下の変形例は、組み合わせて実施例に適用してもよい。
【０１０８】
（変形例１）
図１に示す地図更新システムの構成は一例であり、本発明が適用可能な地図更新システムの構成は図１に示す構成に限定されない。例えば、地図更新システムは、車載機１を有する代わりに、車両の電子制御装置が図７等に示す処理を実行してもよい。この場合、ライダ設置情報ＩＬ及び地図ＤＢ１０等は、例えば車両内の記憶部に記憶され、車両の電子制御装置は、ライダ２の出力データを受信し、ライダ設置情報ＩＬ及び地図ＤＢ１０を参照することで、図７等に示す処理を実行する。
【０１０９】
（変形例２）
車載機１のライダ位置姿勢推定部１９が実行するライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔ等の算出処理を、サーバ装置６の制御部６５が代わりに実行してもよい。
【０１１０】
この場合、例えば、車載機１がサーバ装置６に送信するアップロード情報Ｉｕには、ライダ２の位置姿勢にずれが生じていない時の車両座標系におけるライダ２の位置姿勢［Ｌｘ０、Ｌｙ０、Ｌｚ０、Ｌφ０、Ｌθ０、Ｌψ０］Ｔの情報、及び、ライダ２の位置姿勢を検知するための１又は複数のセンサの出力データなどが含まれる。そして、サーバ装置６は、アップロード情報Ｉｕを受信した場合に、アップロード情報Ｉｕに含まれるセンサの出力データ等に基づき、ライダ位置姿勢推定部１９と同様にライダ２の位置姿勢を推定することで、ライダ位置姿勢変化量［ΔＬｘ、ΔＬｙ、ΔＬｚ、ΔＬφ、ΔＬθ、ΔＬψ］Ｔの算出及びライダ位置姿勢精度「σＬｘ、σＬｙ、σＬｚ、σＬφ、σＬθ、σＬψ」Ｔの算出を行う。この態様によっても、サーバ装置６は、図８に示す地図更新処理に必要な情報を取得して配信地図ＤＢ２２の更新を好適に実行することができる。
【０１１１】
（変形例３）
図６に示すアップロード情報Ｉｕのデータ構造は一例であり、本発明に適用可能なデータ構造はこれに限定されない。
【０１１２】
例えば、アップロード情報Ｉｕには、座標変換フラグが含まれていなくともよい。この場合、例えば、アップロード情報Ｉｕに含まれる計測値は、必ずライダ座標系により表されており、アップロード情報Ｉｕを受信したサーバ装置６は、受信した全てのアップロード情報Ｉｕの計測値に対して、ライダ座標系からワールド座標系への座標変換の処理を行う。
【０１１３】
他の例では、座標変換フラグが「２」である場合、即ち、アップロード情報Ｉｕの計測値がワールド座標系により表されている場合には、アップロード情報Ｉｕには、「ライダ位置姿勢」及び「推定自車位置」等は含まれなくともよい。また、座標変換フラグが「１」である場合、即ち、アップロード情報Ｉｕの計測値が車両座標系により表されている場合には、アップロード情報Ｉｕには、「ライダ位置姿勢」等は含まれなくともよい。
【０１１４】
さらに別の例では、ライダ設置情報ＩＬに含まれるライダ２の初期の位置姿勢［Ｌｘ０、Ｌｙ０、Ｌｚ０、Ｌφ０、Ｌθ０、Ｌψ０］Ｔ等の情報が予めサーバ装置６に記憶されている場合には、アップロード情報Ｉｕには、「ライダ位置姿勢」が含まれていなくともよい。この場合であっても、サーバ装置６は、アップロード情報Ｉｕに含まれるライダ位置姿勢変化量と、予め記憶したライダ２の初期の位置姿勢とに基づき、現在のライダ２の位置姿勢を好適に特定し、計測値の座標変換に用いることができる。
【０１１５】
（変形例４）
サーバ装置６は、図８のステップＳ２０６における重み付け平均処理を行う代わりに、全ての計測値を等しい重みにより平均処理（即ち重み付け値によらない平均化）を行ってもよい。この場合、アップロード情報Ｉｕには、ライダ位置姿勢推定精度及び推定自車位置精度等の重み付け値の決定にのみ用いる情報が含まれなくともよい。
【符号の説明】
【０１１６】
１  車載機
２  ライダ
３  ジャイロセンサ
４  加速度センサ
５  ＧＰＳ受信機
６  サーバ装置
１０  地図ＤＢ
２２  配信地図ＤＢ
【図１】
2020046413.tif 000018
【図２】
2020046413.tif 000019
【図３】
2020046413.tif 000020
【図４】
2020046413.tif 000021
【図５】
2020046413.tif 000022
【図６】
2020046413.tif 000023
【図７】
2020046413.tif 000024
【図８】
2020046413.tif 000025