(57)【要約】【課題】非同期の複数センサのセンサ数が不定であっても、複数センサの結果を統合して、移動物の状態量を精度良く求めることができるようにする。【解決手段】センシング結果獲得部１４が、数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取る。移動物状態量予測部１８が、複数の移動物それぞれについて、移動物状態量記憶部１６に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する。移動物状態量整合部２０が、センシング結果獲得部１４によって検出結果を受け取る毎に、移動物可動範囲地図３０を用いて、検出結果の時刻に対応して移動物状態量予測部１８によって複数の移動物それぞれについて予測された移動物の状態量と、複数の移動物それぞれの検出結果との対応付けを行い、移動物状態量記憶部１６に格納された、複数の移動物それぞれの、状態量及び最後に観測した時刻を更新する。【選択図】図２
2018147157.tif 000002
【特許請求の範囲】
【請求項１】
複数の移動物それぞれの、状態量及び最後に観測した時刻を記憶する移動物状態量記憶手段と、
前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する移動物状態量予測手段と、
数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取るセンシング結果獲得手段と、
前記センシング結果獲得手段によって前記検出結果を受け取る毎に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新する移動物状態量整合手段と、
を含む移動物状態量推定装置。
【請求項２】
複数の移動物それぞれの、状態量及び最後に観測した時刻を記憶する移動物状態量記憶手段と、
前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する移動物状態量予測手段と、
数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取るセンシング結果獲得手段と、
前記センシング結果獲得手段によって前記検出結果を受け取った場合に、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新し、
前記センシング結果獲得手段によって前記検出結果を受け取らなかった場合に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量を修正し、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量を更新する移動物状態量整合手段と、
を含む移動物状態量推定装置。
【請求項３】
前記移動物状態量整合手段は、前記センシング結果獲得手段によって前記検出結果を受け取らなかった場合に、前記複数の移動物それぞれについて、前記移動物状態量予測手段によって前記移動物について予測された前記移動物の状態量に基づいてサンプリングして得られる、前記移動物の状態量を表す複数のパーティクルを生成し、前記複数のパーティクルと、前記移動物可動範囲情報とに基づいて、前記移動物について予測された前記移動物の状態量を修正し、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量を更新する請求項２記載の移動物状態量推定装置。
【請求項４】
前記複数センサは、各々異なる移動体に搭載されたセンサを含む請求項１〜請求項３の何れか１項記載の移動物状態量推定装置。
【請求項５】
前記移動物状態量整合手段によって前記検出結果と対応付かなった前記移動物の状態量であって、前記最後に観測した時刻から一定時間以上経過している前記移動物の状態量を、前記移動物状態量記憶手段から消去する移動物状態量消去手段を更に含む請求項１〜請求項４の何れか１項記載の移動物状態量推定装置。
【請求項６】
前記複数の移動物それぞれの存在確率を記憶する移動物存在確率記憶手段と、
前記移動物状態量整合手段による前記検出結果との対応付けの結果、又は前記センサについて予め定められた検出精度に応じて、前記移動物の存在確率を、前記移動物存在確率記憶手段に設定し、又は
前記移動物存在確率記憶手段に記憶されている前記複数の移動物それぞれの存在確率を、前記移動物状態量整合手段による前記検出結果との対応付けの結果、前記最後に観測した時刻からの経過時間、又は前記センサについて予め定められた検出精度に応じて増減させる移動物存在確率更新手段と、
を更に含み、
前記移動物状態量消去手段は、前記移動物存在確率記憶手段に記憶されている前記複数の移動物それぞれの存在確率に基づいて、前記移動物の状態量を、前記移動物状態量記憶手段から消去する請求項５記載の移動物状態量推定装置。
【請求項７】
前記移動物状態量予測手段は、前記移動物可動範囲情報を制約として用いて、次の時刻の前記移動物の状態量を予測する請求項１〜請求項６の何れか１項記載の移動物状態量推定装置。
【請求項８】
前記移動物存在確率更新手段は、前記移動物可動範囲情報を制約として用いて、前記移動物存在確率記憶手段に記憶されている前記複数の移動物それぞれの存在確率を増減させる請求項６記載の移動物状態量推定装置。
【請求項９】
前記複数センサは、複数の車両に搭載された、又はインフラセンサに用いられた、歩行者又は車両を検出する複数の検出器であって、
前記移動物の状態量は、歩行者又は車両の位置及び速度であって、
前記移動物可動範囲情報は、道路又は歩道を表す地図である請求項１〜請求項８の何れか１項記載の移動物状態量推定装置。
【請求項１０】
前記複数センサは、単一の車両に搭載された、カメラ及びレーダを含む複数の計測器を用いた、歩行者又は車両を検出する複数の検出器であって、
前記移動物の状態量は、歩行者又は車両の位置及び速度であって、
前記移動物可動範囲情報は、道路又は歩道を表す地図である請求項１〜請求項８の何れか１項記載の移動物状態量推定装置。
【請求項１１】
複数の移動物それぞれの、状態量及び最後に観測した時刻を記憶する移動物状態量記憶手段を含むコンピュータを、
前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する移動物状態量予測手段、
数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取るセンシング結果獲得手段、及び
前記センシング結果獲得手段によって前記検出結果を受け取る毎に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新する移動物状態量整合手段
として機能させるためのプログラム。
【請求項１２】
複数の移動物それぞれの、状態量及び最後に観測した時刻を記憶する移動物状態量記憶手段を含むコンピュータを、
前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する移動物状態量予測手段、
数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取るセンシング結果獲得手段、及び
前記センシング結果獲得手段によって前記検出結果を受け取った場合に、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新し、
前記センシング結果獲得手段によって前記検出結果を受け取らなかった場合に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量を修正し、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量を更新する移動物状態量整合手段
として機能させるためのプログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、移動物状態量推定装置及びプログラムに関する。
【背景技術】
【０００２】
従来より、複数のカメラ映像を用いて、複数の歩行者が歩いているシーンから隠れ（オクルージョン）ている歩行者の動きを捉えるために、複数カメラの配置・向き情報と複数のカメラ映像から抽出した歩行者の足領域情報を利用して時空間トラッキングをしながら、歩行者を分離・追跡する技術が知られている（非特許文献１）。
【０００３】
また、複数のカメラ映像を用いて、車両領域を表すテンプレート位置を抽出し、テンプレート位置情報に対して、多視点的処理と時系列処理を施し、複数のカメラで検出された車両の対応付けを行うことで、走行車両の運動軌道を高精度に計算することができる走行車両検出装置が知られている（特許文献１）。
【先行技術文献】
【非特許文献】
【０００４】
【非特許文献１】S.M. Khan, et. al., “A multiview approach to tracking people in crowded scenes using a planar homography constraint,” Proceedings of the 9th European conference on Computer Vision, ECCV06, Vol. 4, pp133-146.
【特許文献】
【０００５】
【特許文献１】特開2001-357489号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
上記非特許文献１及び特許文献１の技術は、共にビデオフレームが一定間隔で、複数のカメラ（センサ）間でフレーム同期がとれることを前提としている。
【０００７】
しかしながら、通信遅延やセンサの仕様で複数のセンサ間でフレーム同期（検出結果送信タイミングの同期）がとれない場合は、一定時間のフレームを、結果を統合する装置上で蓄積し、データ補間等の同期処理を行う必要があり、さらにはセンサ数が不定の場合は、同期するセンサが不定ということであるため、同期処理が困難である。
【０００８】
また、センシング結果から得られる観測量が、障害物の内側などとして明らかに誤っている場合に、既存の状態量と対応づかないと、新規の状態量を生成してしまう。
【０００９】
本発明は、上記の事情に鑑みてなされたもので、非同期の複数センサのセンサ数が不定であっても、複数センサの結果を統合して、移動物の状態量を精度良く求めることができる移動物状態量推定装置及びプログラムを提供することを目的とする。
【課題を解決するための手段】
【００１０】
上記の目的を達成するために第１の発明に係る移動物状態量推定装置は、複数の移動物それぞれの、状態量及び最後に観測した時刻を記憶する移動物状態量記憶手段と、前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する移動物状態量予測手段と、数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取るセンシング結果獲得手段と、前記センシング結果獲得手段によって前記検出結果を受け取る毎に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新する移動物状態量整合手段と、を含んで構成されている。
【００１１】
第２の発明に係るプログラムは、複数の移動物それぞれの、状態量及び最後に観測した時刻を記憶する移動物状態量記憶手段を含むコンピュータを、前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する移動物状態量予測手段、数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取るセンシング結果獲得手段、及び前記センシング結果獲得手段によって前記検出結果を受け取る毎に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新する移動物状態量整合手段として機能させるためのプログラムである。
【００１２】
第１の発明及び第２の発明によれば、センシング結果獲得手段によって、数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取る。移動物状態量予測手段によって、前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する。
【００１３】
そして、移動物状態量整合手段によって、前記センシング結果獲得手段によって前記検出結果を受け取る毎に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新する。
【００１４】
このように、数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取る毎に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、検出結果の時刻に対応して複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、複数の移動物それぞれの、状態量及び最後に観測した時刻を更新することにより、非同期の複数センサのセンサ数が不定であっても、複数センサの結果を統合して、移動物の状態量を精度良く求めることができる。
【００１５】
第３の発明に係る移動物状態量推定装置は、複数の移動物それぞれの、状態量及び最後に観測した時刻を記憶する移動物状態量記憶手段と、前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する移動物状態量予測手段と、数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取るセンシング結果獲得手段と、前記センシング結果獲得手段によって前記検出結果を受け取った場合に、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新し、前記センシング結果獲得手段によって前記検出結果を受け取らなかった場合に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量を修正し、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量を更新する移動物状態量整合手段と、を含んで構成されている。
【００１６】
第４の発明に係るプログラムは、複数の移動物それぞれの、状態量及び最後に観測した時刻を記憶する移動物状態量記憶手段を含むコンピュータを、前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する移動物状態量予測手段、数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取るセンシング結果獲得手段、及び前記センシング結果獲得手段によって前記検出結果を受け取った場合に、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新し、前記センシング結果獲得手段によって前記検出結果を受け取らなかった場合に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量を修正し、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量を更新する移動物状態量整合手段として機能させるためのプログラムである。
【００１７】
第３の発明及び第４の発明によれば、センシング結果獲得手段によって、数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取る。移動物状態量予測手段によって、前記複数の移動物それぞれについて、前記移動物状態量記憶手段に記憶された状態量を用いて次の時刻の前記移動物の状態量を予測する。
【００１８】
そして、移動物状態量整合手段によって、前記センシング結果獲得手段によって前記検出結果を受け取った場合に、前記検出結果の時刻に対応して前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量及び最後に観測した時刻を更新する。
【００１９】
また、移動物状態量整合手段によって、前記センシング結果獲得手段によって前記検出結果を受け取らなかった場合に、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、前記移動物状態量予測手段によって前記複数の移動物それぞれについて予測された前記移動物の状態量を修正し、前記移動物状態量記憶手段に格納された、前記複数の移動物それぞれの、状態量を更新する。
【００２０】
このように、数不定の複数センサの何れかからも、複数の移動物を検出した検出結果を受け取らなかった場合には、移動物の可動範囲が記録されている移動物可動範囲情報を用いて、複数の移動物それぞれについて予測された前記移動物の状態量を修正し、数不定の複数センサの何れかから、複数の移動物を検出した検出結果を受け取った場合に、検出結果の時刻に対応して複数の移動物それぞれについて予測された前記移動物の状態量と、複数の移動物それぞれの前記検出結果との対応付けを行い、複数の移動物それぞれの、状態量及び最後に観測した時刻を更新することにより、非同期の複数センサのセンサ数が不定であっても、複数センサの結果を統合して、移動物の状態量を精度良く求めることができる。
【００２１】
また、上記発明のプログラムは、記録媒体に格納して提供することも可能である。
【発明の効果】
【００２２】
以上説明したように、本発明の移動物状態量推定装置及びプログラムによれば、非同期の複数センサのセンサ数が不定であっても、複数センサの結果を統合して、移動物の状態量を精度良く求めることができる、という効果が得られる。
【図面の簡単な説明】
【００２３】
【図１】本発明の第１の実施の形態に係る歩行者状態量推定システムを示すブロック図である。
【図２】本発明の第１の実施の形態に係る局地サーバを示すブロック図である。
【図３】本発明の第１の実施の形態に係る局地サーバにおける歩行者状態量推定処理ルーチンの内容を示すフローチャートである。
【図４】歩行者の可動範囲を考慮して複数センサの結果を統合する方法を説明するための図である。
【図５】歩行者状態量推定システムでのデータの送受信を示す図である。
【図６】歩行者の可動範囲を考慮して複数センサの結果を統合する方法の効果を説明するための図である。
【図７】歩行者の可動範囲を考慮して状態量の予測結果を修正する方法を説明するための図である。
【図８】本発明の第２の実施の形態に係る局地サーバを示すブロック図である。
【図９】非同期の複数センサからの検出結果を用いた存在確率に基づくセンシング結果統合のイメージ図である。
【図１０】本発明の第２の実施の形態に係る局地サーバにおける歩行者状態量推定処理ルーチンの内容を示すフローチャートである。
【図１１】本発明の第３の実施の形態に係る局地サーバを示すブロック図である。
【発明を実施するための形態】
【００２４】
以下、図面を参照して、本発明の実施の形態について説明する。
【００２５】
＜本発明の実施の形態の概要＞
本発明の実施の形態は、複数のセンサ間でフレーム同期をしないアプローチをとっている。あるセンサからのセンシング結果を受け取ったタイミングで、歩行者位置の状態量（仮説）と受け取ったセンシング結果を対応付けて、誤差を計算し、仮説の歩行者位置を補正しながら、歩行者を検出・追従する。この処理を各センサからセンシング結果が統合処理装置に届く毎に行う。
【００２６】
しかしながら、本アプローチは、１台のセンサの結果だけを使って逐次上記処理を行うため、センサの検出率が悪い場合（歩行者がいない所に誤って歩行者がいると結果を出す頻度が高い場合）には、いない歩行者の仮説が増えてしまい、歩行者数の推定を間違ってしまう問題がある。
【００２７】
この問題を解決するために、各センサの検出率や最後に観測されてからの経過時間、地図情報などを利用して、誤検出の可能性が高い歩行者の検出結果を棄却する。
【００２８】
また、各センサから非同期に到達した情報から生成した観測量と、その空間的な移動可能性（可動範囲）と、既に保持している状態量の移動予測との近さに応じて、整合処理（対応付けと状態量の修正）を行い、適切な対応付けがない場合には、観測量周辺に可動範囲を鑑みて状態量を生成する。観測量が到来しない間も、可動範囲による状態量の修正は継続する。これにより、通信途絶によって観測量が得られない間も、例えば歩行者は歩道上を進行するなど、常識的な予測が実現されるので、通信復帰後の観測量と既存の状態量とを適切に対応付けることができる。既に保持している状態量は、最後に対応付けられてからの経過時間で削除するので、極めて長期間の途絶に対してのロバスト性は維持される。
【００２９】
［第１の実施の形態］
本発明の第１の実施の形態では、車両に搭載された歩行者の検出器やインフラセンサとしての歩行者の検出器の検出結果を統合して歩行者の状態量を推定する局地サーバに本発明を適用した場合を例に説明する。
【００３０】
＜歩行者状態量推定システムのシステム構成＞
図１に示すように、第１の実施の形態に係る歩行者状態量推定システム１００は、局地サーバ１０と、基地局５０と、複数の車両に搭載された複数の検出器６０と、インフラセンサとしての検出器６２とを備え、基地局５０と局地サーバ１０とは、インターネットなどのネットワーク７０で接続されており、基地局５０と検出器６０、６２とは、無線通信により接続されている。なお、局地サーバ１０は、移動物状態量推定装置の一例である。
【００３１】
検出器６０、６２は、カメラやレーダを用いて歩行者を随時検出し、検出する度に、検出結果を、基地局５０を介して、局地サーバ１０へ送信する。
【００３２】
例えば、検出器６０は、自車両の前方を撮像するカメラによって撮像された前方の道路画像から、スライディングウィンドウ毎に、画像特徴量（ＳＩＦＴ，ＦＩＮＤ、ＨＯＧなど）を抽出し、スライディングウィンドウ毎の画像特徴量と、歩行者検出モデル（ＳＶＭ、ＡｄａＢｏｏｓｔ）とを用いて、歩行者を検出し、検出された歩行者位置を表す画像座標を求める。また、検出器６０は、歩行者位置を表す画像座標を、３次元位置に変換する。この際に、検出された歩行者の高さに応じて誤差分散行列を求める。また、検出器６０は、自車両に搭載されたＧＰＳにより計測された自車両の絶対座標と、求められた３次元位置とに基づいて、歩行者の絶対的な３次元位置を求める。
【００３３】
上記の歩行者の３次元位置及び誤差分散行列を、検出された歩行者毎に求め、車両Ｃｉの検出器６０において検出した歩行者の３次元位置のセットＹｉ＝｛ｙｉ，１，…ｙｉ，ｍ｝と、観測誤差分散行列のセットＲｉ＝｛ｒｉ，１，…，ｒｉ，ｍ｝とからなる観測Ｏｉ＝｛Ｙｉ，Ｒｉ｝を、観測毎に、局地サーバ１０へ送信する。
【００３４】
検出器６２は、検出器６０と同様に、検出した歩行者の３次元位置のセットと、観測誤差分散行列のセットとからなる観測を、観測毎に、局地サーバ１０へ送信する。
【００３５】
複数の検出器６０、６２は、非同期に、歩行者を検出している。また、複数の検出器６０は、各々異なる車両に搭載されているため、局地サーバ１０へ検出結果を送信する検出器６０、６２の数は、不定となる。
【００３６】
局地サーバ１０は、ＣＰＵと、ＲＡＭと、後述する歩行者状態量推定処理ルーチンを実行するためのプログラムを記憶したＲＯＭとを備え、機能的には次に示すように構成されている。図２に示すように、局地サーバ１０は、通信部１２と、センシング結果獲得部１４と、移動物状態量記憶部１６と、移動物状態量予測部１８と、移動物状態量消去部１９と、移動物状態量整合部２０と、移動物状態量更新部２４と、移動物可動範囲地図３０とを備えている。
【００３７】
移動物可動範囲地図３０には、障害物や標識表示による歩行者の可動範囲地図を表わす尤度場ｍが格納されている。尤度場ｍは、例えば遠隔サーバ８０から取得され、所定の周期で移動物可動範囲地図３０の尤度場ｍが更新される。例えば、信号機による変化を想定した場合、１秒〜１０秒の周期で、移動物可動範囲地図３０の尤度場ｍが更新される。整備工事（補修、植栽剪定等）による規制を想定した場合には、１時間の周期で、移動物可動範囲地図３０の尤度場ｍが更新される。また、道路構造の変更（道路の撤去／新設、建物の築造・増築／撤去）を想定した場合には、１日の周期で、移動物可動範囲地図３０の尤度場ｍが更新される。
【００３８】
センシング結果獲得部１４は、検出器６０、６２の何れかから送信された歩行者の座標のセット及び観測誤差分散行列のセットからなる観測を、通信部１２により受信する毎に、歩行者の座標のセット及び観測誤差分散行列のセットからなる観測を取得する。
【００３９】
移動物状態量記憶部１６は、観測された複数の歩行者それぞれの、移動物状態量更新部２４により更新された状態量（歩行者の位置及び速度）、及び最後に観測した時刻を記憶する。具体的には、歩行者の状態量のセットＸ＝｛ｘ１，…ｘｎ｝、および、状態量の分散共分散行列Ｖ＝｛ｖ１，…，ｖｎ｝、最後に観測した時刻のセットＴ＝｛ｔ１，…ｔｎ｝とを記憶している。なお、本実施の形態では、
2018147157.tif 000003
を、信念空間上の仮説と呼び、その構成要素
2018147157.tif 000004
を追跡器と呼ぶこととする。
【００４０】
移動物状態量予測部１８は、現時刻に合わせて、複数の歩行者それぞれについて、パーティクルフィルタの予測ステップにより、移動物状態量記憶部１６に記憶された状態量を用いて次の時刻の歩行者の状態量を予測することを繰り返し、現時刻における歩行者の状態量のセットＸ＝｛ｘ１，…ｘｎ｝、および、状態量の分散共分散行列Ｖ＝｛ｖ１，…，ｖｎ｝を求める。例えば、等速予測などにより、次の時刻の歩行者の状態量を予測する。
【００４１】
具体的には、仮説
2018147157.tif 000005
に対して、現時刻の状態に関する予測
2018147157.tif 000006
を生成する。
【００４２】
移動物状態量整合部２０は、センシング結果獲得部１４により最新の観測Ｏｉを受け取った場合に、移動物可動範囲地図３０の尤度場ｍを用いて、現時刻に対応して移動物状態量予測部１８によって複数の歩行者それぞれについて予測された状態量と、当該最新の観測Ｏｉが表す複数の歩行者それぞれの検出結果との対応付けを行う。
【００４３】
具体的には、移動物可動範囲地図３０の尤度場ｍを用いて、現時刻における歩行者の状態量のセットＸ＝｛ｘ１，…ｘｎ｝と、当該最新の観測Ｏｉにおいて検出した歩行者の３次元位置のセットＹｉ＝｛ｙｉ，１，…ｙｉ，ｍ｝との対応付けを行う。例えば、観測Ｏｉに対する、追跡器
2018147157.tif 000007
のあてはまりのよさを意味する観測尤度
2018147157.tif 000008
を、尤度場ｍ（ｘn）を含めて以下のように計算する。
【００４４】
【数１】
2018147157.tif 000009
【００４５】
そして、対応付けられた追跡器
2018147157.tif 000010
と検出された歩行者の３次元位置ｙｉ，ｊとの組み合わせの観測尤度θｉ，ｊの積を最大にする対応付けを、ハンガリアン法などの手法により高速に計算する。
【００４６】
また、対応付けない観測尤度を設定値として与え、この設定値より小さい観測尤度の組み合わせは、対応付けられないようにする。
【００４７】
移動物状態量整合部２０は、センシング結果獲得部１４により最新の観測Ｏｉを受け取らなかった場合に、現時刻に対応して移動物状態量予測部１８によって複数の追跡器それぞれについて予測された状態量に基づいてサンプリングして得られる、歩行者の状態量を表す複数のパーティクルを、追跡器ぞれぞれに対して生成し、パーティクルの各々に対し、移動物可動範囲地図３０の尤度場ｍを用いて、地図尤度ωを算出する。
【００４８】
具体的には、状態予測
2018147157.tif 000011
に関して、シグマポイント
2018147157.tif 000012
によるサンプリングを行う。
【００４９】
【数２】
2018147157.tif 000013
【００５０】
ここで、α、кはシグマポイントの平均値からのひろがりを調整する設定パラメータである。また、ｄはｘnの次元である。一つの追跡器に対して、例えば、３つのパーティクルψn,1、ψn,2、ψn,3を生成する。
【００５１】
そして、シグマポイントψに関する地図尤度
2018147157.tif 000014
を、尤度場ｍ（ψn）から以下のように算出する。
【００５２】
【数３】
2018147157.tif 000015
【００５３】
移動物状態量更新部２４は、センシング結果獲得部１４により最新の観測Ｏｉを受け取った場合に、移動物状態量整合部２０により最新の観測Ｏｉと対応付けられた追跡器の各々について、対応する３次元位置ｙｉ，ｊを観測値として、その誤差分散行列ｒｉ，ｊと、予測ステップで得られた歩行者の状態量及び分散共分散行列と用いて、パーティクルフィルタのフィルタリングステップにより、状態量を更新すると共に、最後に観測した時刻を更新する。
【００５４】
また、移動物状態量更新部２４は、移動物状態量整合部２０による最新の観測Ｏｉの検出結果との対応付けの結果に基づいて、最新の観測Ｏｉのうち、追跡器と対応付かなかった歩行者の検出結果から、新たな状態量ｘを含む追跡器を生成し、最後に観測した時刻として、現在時刻を、移動物状態量記憶部１６に格納する。なお、新たな状態量ｘを含む追跡器は、観測された歩行者の３次元位置ｙと同じ座標、誤差分散行列を持つこととする。
【００５５】
移動物状態量更新部２４は、センシング結果獲得部１４により最新の観測Ｏｉを受け取らなかった場合に、追跡器の各々について、移動物状態量整合部２０により求められた地図尤度ωを重みとする重み付き平均によって、追跡器
2018147157.tif 000016
の状態量及び分散共分散行列を更新する。
【００５６】
【数４】
2018147157.tif 000017
【００５７】
移動物状態量消去部１９は、最後に観測した時刻から一定時間以上経過している歩行者の状態量を含む追跡器を、移動物状態量記憶部１６から消去する。
【００５８】
局地サーバ１０は、上記の一連の処理により更新された状態量のセットＸを、歩行者の検出結果の統合結果として出力する。
【００５９】
＜歩行者状態量推定システム１００の動作＞
次に、第１の実施の形態に係る歩行者状態量推定システム１００の動作について説明する。まず、複数の車両に搭載された複数の検出器６０、及びインフラセンサとしての検出器６２の各々によって、歩行者が逐次検出され、検出される毎に、検出結果が、基地局５０を介して、局地サーバ１０に送信されているときに、局地サーバ１０において、図３に示す歩行者状態量推定処理ルーチンが実行される。
【００６０】
ステップＳ１００において、以下のように仮説を空集合に初期化する。
【００６１】
【数５】
2018147157.tif 000018
【００６２】
ステップＳ１０２は、前回のステップＳ１０４での処理時刻と現時刻との差分を算出する。
【００６３】
そして、ステップＳ１０４において、上記ステップＳ１０２で算出した差分時刻の分だけ、複数の歩行者に対応する複数の追跡器それぞれについて、パーティクルフィルタの予測ステップにより、移動物状態量記憶部１６に記憶された状態量を用いて次の時刻の歩行者の状態量を予測することを繰り返し、現時刻における歩行者の状態量のセットＸ＝｛ｘ１，…ｘｎ｝、および、その分散共分散行列Ｖ＝｛ｖ１，…，ｖｎ｝を求める。
【００６４】
ステップＳ１０６では、最後に観測した時刻から一定時間以上経過している歩行者の状態量を含む追跡器を、移動物状態量記憶部１６から消去する（図４参照）。
【００６５】
そして、ステップＳ１０８では、複数の検出器６０及び検出器６２の何れかから、歩行者の検出結果として、歩行者の３次元位置のセットＹｉ＝｛ｙｉ，１，…ｙｉ，ｍ｝と、観測誤差分散行列のセットＲｉ＝｛ｒｉ，１，…，ｒｉ，ｍ｝とからなる最新の観測Ｏｉを受信したか否かを判定する。最新の観測Ｏｉを受信した場合には、ステップＳ１１０へ移行し、最新の観測を受信しなかった場合には、ステップＳ１２０へ移行する。
【００６６】
ステップＳ１１０では、上記ステップＳ１００で受信した最新の観測Ｏｉに含まれる歩行者の３次元位置を、センサ座標系から世界座標系に変換する。
【００６７】
ステップＳ１１２では、最新の観測Ｏｉと、上記ステップＳ１０４で予測された予測結果と、移動物可動範囲地図３０の尤度場ｍとに基づいて、追跡器
2018147157.tif 000019
の各々に対し、当該追跡器のあてはまりのよさを意味する観測尤度θiを計算する。
【００６８】
ステップＳ１１４では、上記ステップＳ１１２で計算された観測尤度θiに基づいて、追跡器
2018147157.tif 000020
と最新の観測Ｏｉで検出された歩行者の３次元位置との対応付けを行う。
【００６９】
ステップＳ１１６では、上記ステップＳ１１４で最新の観測Ｏｉで検出された歩行者の３次元位置と対応付けられた追跡器の各々について、対応する３次元位置ｙｉ，ｊを観測値として、その誤差分散行列ｒｉ，ｊと上記ステップＳ１０４で得られた当該追跡器の歩行者の状態量及び分散共分散行列とを用いて、パーティクルフィルタのフィルタリングステップにより、状態量を更新すると共に、最後に観測した時刻を更新する。また、最新の観測Ｏｉで検出された歩行者の３次元位置のうち、追跡器と対応付かなかった歩行者の３次元位置に基づき、新たな状態量xを含む追跡器を生成し（図４参照）、最後に観測した時刻として、現在時刻を、移動物状態量記憶部１６に格納する。
【００７０】
そして、ステップＳ１１８では、更新された状態量のセットＸを、歩行者の検出結果の統合結果として出力し、上記ステップＳ１０２へ戻る。例えば、歩行者の検出結果の統合結果が、遠隔サーバ８０へ送信される（図５参照）。
【００７１】
ステップＳ１２０では、現時刻に対応して移動物状態量予測部１８によって追跡器について予測された状態量に基づいてサンプリングして得られる、歩行者の状態量を表す複数のパーティクルを、複数の追跡器ぞれぞれに対して生成する。
【００７２】
ステップＳ１２２において、複数の追跡器毎に、上記ステップＳ１２０で生成されたパーティクルの各々に対し、移動物可動範囲地図３０の尤度場ｍを用いて、地図尤度ωを算出する。
【００７３】
ステップＳ１２４では、追跡器の各々について、上記ステップＳ１２０で生成されたパーティクルの各々と、上記ステップＳ１２２で求められた地図尤度ωとに基づいて、地図尤度ωを重みとする重み付き平均によって、当該追跡器の状態量を更新し、上記ステップＳ１０２へ戻る。
【００７４】
以上説明したように、第１の実施の形態に係る歩行者状態量推定システムによれば、数不定の複数の検出器の何れかから、複数の歩行者を検出した検出結果を受け取る毎に、移動物可動範囲地図を用いて、検出結果の時刻に対応して複数の歩行者それぞれについて予測された歩行者の状態量と、複数の歩行者それぞれの検出結果との対応付けを行い、複数の歩行者それぞれの、状態量及び最後に観測した時刻を更新することにより、非同期の複数センサのセンサ数が不定であっても、複数センサの結果を統合して、歩行者の状態量を精度良く求めることができる。
【００７５】
また、数不定の複数の検出器の何れかからも、複数の歩行者を検出した検出結果を受け取らなかった場合には、移動物可動範囲地図を用いて、複数の歩行者それぞれについて予測された歩行者の状態量を修正し、数不定の複数の検出器の何れかから、複数の歩行者を検出した検出結果を受け取った場合に、検出結果の時刻に対応して複数の歩行者それぞれについて予測された歩行者の状態量と、複数の歩行者それぞれの検出結果との対応付けを行い、複数の歩行者それぞれの、状態量及び最後に観測した時刻を更新することにより、非同期の複数センサのセンサ数が不定であっても、複数センサの結果を統合して、歩行者の状態量を精度良く求めることができる。
【００７６】
また、非同期に不特定の複数センサからセンシング結果が来る場合に、一つのセンサ情報から追加した状態量を、検出からの経過時間に基づいて削除することにより、信頼できない検出結果の影響が状態量として残らないようにすることで、各センサの誤検出にロバストになる。このように、非同期に来る複数センサからのセンシング結果をリアルタイムに統合処理をする場合に、各センサの誤検出にロバストになる。
【００７７】
また、歩行者の可動範囲を、整合処理に直接組み込むことで、観測が誤っていても適切に追跡器と検出結果とを対応付けることができる（図６参照）。また、センシング結果が到達する度に、歩行者の位置・速度等の状態量（仮説）と対応付けて近さ（誤差）を計算し、仮説の状態量を補正しながら追跡することができる。観測量が到達しない間、既存の状態量は、歩行者の可動範囲を参照して継続的に移動予測がなされる。さらに、歩行者の可動範囲が整合処理に直接組み込まれることで、障害物の内部など、明らかに歩行者が存在し得ない位置に状態量を生成することも防ぐことができる。
【００７８】
また、センシング結果から歩行者か車両かといった大まかな情報が判っていれば、整合処理内で移動予測結果が修正されるので、移動物に関する詳細な移動制御モデルがなくても、妥当な予測が可能となる（図７参照）。
【００７９】
また、センシング結果から移動物の属性を認識し、移動物の属性によって異なる尤度場を用いるようにしてもよい。例えば、以下の表１に示すように、歩行者用尤度場、自動車用尤度場、自転車用尤度場を用意し、パーティクルの属性に応じて、異なる尤度場に切り替えてフィルタリングすることもできる。
【００８０】
【表１】
2018147157.tif 000021
【００８１】
また、ネットワークを介して非同期に到達する複数センサからのセンシング結果をリアルタイムに統合処理をする場合に、一時的な通信途絶や誤検出・未検出に対してロバストになる。
【００８２】
［第２の実施の形態］
＜歩行者状態量推定システムのシステム構成＞
次に、第２の実施の形態に係る歩行者状態量推定システムについて説明する。なお、第１の実施の形態と同様の構成となる部分については、同一符号を付して説明を省略する。
【００８３】
第２の実施の形態では、複数の歩行者それぞれの存在確率を保持し、検出結果と状態量との対応付けに基づいて、複数の歩行者それぞれの存在確率を更新している点と、状態量を予測する際に、歩行者の可動範囲を考慮している点とが第１の実施の形態と異なっている。
【００８４】
図８に示すように、第２の実施の形態に係る局地サーバ２１０は、通信部１２と、センシング結果獲得部１４と、移動物状態量記憶部１６と、移動物状態量予測部２１８と、移動物状態量消去部１９と、移動物状態量整合部２０と、移動物状態量更新部２４と、移動物存在確率更新部２２０と、移動物存在確率記憶部２２２と、移動物可動範囲地図３０とを備えている。
【００８５】
移動物存在確率記憶部２２２は、移動物状態量記憶部１６に記憶されている複数の追跡器に対応する複数の歩行者それぞれの存在確率を記憶する。
【００８６】
移動物存在確率更新部２２０は、移動物状態量整合部２０による最新の観測との対応付けの結果に基づいて、最新の観測のうち、追跡器と対応付かなかった歩行者の検出結果に対し、当該歩行者の存在確率として、設定値を移動物存在確率記憶部２２２に格納する。設定値は、検出器６０、６２について予め定められた検出精度に応じて定めればよい。
【００８７】
また、移動物存在確率更新部２２０は、移動物存在確率記憶部２２２に記憶されている複数の歩行者それぞれの存在確率のうち、移動物状態量整合部２０により最新の観測の検出結果と対応付けられた追跡器の歩行者の存在確率の各々について、検出器６０、６２について予め定められた検出精度に応じて増加させるように更新する（図９参照）。
【００８８】
また、移動物存在確率更新部２２０は、移動物存在確率記憶部２２２に記憶されている複数の歩行者それぞれの存在確率のうち、移動物状態量整合部２０により最新の観測の検出結果と対応付けられなかった追跡器の歩行者の存在確率の各々について、最後に観測した時刻からの経過時間に応じた存在確率となるように減衰させて更新する（図９参照）。
【００８９】
移動物状態量消去部１９は、移動物存在確率記憶部２２２に記憶されている存在確率が閾値を下回った歩行者の状態量を含む追跡器を消去する（図９参照）。なお、閾値は、最後に観測した時刻から一定時間以上経過している歩行者の存在確率に対応した値とする。
【００９０】
移動物状態量予測部２１８は、現時刻に合わせて、複数の歩行者それぞれについて、パーティクルフィルタの予測ステップにより、移動物状態量記憶部１６に記憶された状態量を用いて次の時刻の歩行者の状態量を予測することを繰り返し、現時刻における歩行者の状態量のセットＸ＝｛ｘ１，…ｘｎ｝、および、その分散共分散行列Ｖ＝｛ｖ１，…，ｖｎ｝を求める。このとき、歩行者の状態量に含まれる位置が、移動物可動範囲地図３０が定める歩行者が位置することが可能な範囲外である場合には、歩行者の状態量に含まれる位置が、移動物可動範囲地図３０が定める歩行者が位置することが可能な範囲内となるように、当該歩行者の状態量を修正する。
【００９１】
なお、第２の実施の形態に係る歩行者状態量推定システムの他の構成は、第１の実施の形態と同様であるため、説明を省略する。
【００９２】
＜歩行者状態量推定システムの動作＞
次に、第２の実施の形態に係る歩行者状態量推定システムの動作について説明する。まず、複数の車両に搭載された複数の検出器６０、及びインフラセンサとしての検出器６２の各々によって、歩行者が逐次検出され、検出結果が、基地局５０を介して、局地サーバ２１０に送信されているときに、局地サーバ２１０において、図１０に示す歩行者状態量推定処理ルーチンが実行される。なお、第１の実施の形態と同様の処理については、同一符号を付して詳細な説明を省略する。
【００９３】
ステップＳ１００において、仮説を空集合に初期化する。
【００９４】
ステップＳ１０２は、前回のステップＳ２００での処理時刻と現時刻との差分を算出する。
【００９５】
そして、ステップＳ２００において、上記ステップＳ１０２で算出した差分時刻の分だけ、複数の歩行者に対応する複数の追跡器それぞれについて、パーティクルフィルタの予測ステップにより、移動物状態量記憶部１６に記憶された状態量を用いて次の時刻の歩行者の状態量を予測することを繰り返し、現時刻における複数の歩行者の状態量のセットＸ＝｛ｘ１，…ｘｎ｝、および、その分散共分散行列Ｖ＝｛ｖ１，…，ｖｎ｝を求める。そして、歩行者の状態量に含まれる位置が、移動物可動範囲地図３０が定める歩行者が位置することが可能な範囲外である場合には、歩行者の状態量に含まれる位置が、移動物可動範囲地図３０が定める歩行者が位置することが可能な範囲内となるように、当該歩行者の状態量を修正する。
【００９６】
ステップＳ２０２では、移動物存在確率記憶部２２２に記憶されている存在確率が閾値を下回った歩行者の状態量を含む追跡器を、移動物状態量記憶部１６から消去する。
【００９７】
そして、ステップＳ１０８では、複数の検出器６０及び検出器６２の何れかから、最新の観測Ｏｉを受信したか否かを判定する。最新の観測Ｏｉを受信した場合には、ステップＳ１１０へ移行し、最新の観測を受信しなかった場合には、ステップＳ１２０へ移行する。
【００９８】
ステップＳ１１０では、上記ステップＳ１００で受信した最新の観測Ｏｉに含まれる歩行者の３次元位置を、センサ座標系から世界座標系に変換する。
【００９９】
ステップＳ１１２では、最新の観測Ｏｉと、上記ステップＳ１０４で予測された予測結果と、移動物可動範囲地図３０の尤度場ｍとに基づいて、追跡器
2018147157.tif 000022
の各々に対し、当該追跡器のあてはまりのよさを意味する観測尤度θiを計算する。
【０１００】
ステップＳ１１４では、上記ステップＳ１１２で計算された観測尤度θiに基づいて、追跡器
2018147157.tif 000023
と最新の観測Ｏｉで検出された歩行者の３次元位置との対応付けを行う。
【０１０１】
ステップＳ２０４では、移動物存在確率記憶部２２２に記憶されている複数の歩行者それぞれの存在確率のうち、上記ステップＳ１１４により最新の観測の検出結果と対応付けられた追跡器に対応する歩行者の存在確率の各々について、検出器６０、６２について予め定められた検出精度に応じて増加させるように更新する。また、移動物存在確率記憶部２２２に記憶されている複数の歩行者それぞれの存在確率のうち、上記ステップＳ１１４により最新の観測の検出結果と対応付けられなかった追跡器に対応する歩行者の存在確率の各々について、最後に観測した時刻からの経過時間に応じた存在確率となるように減衰させて更新する。
【０１０２】
ステップＳ１１６では、上記ステップＳ１１４で最新の観測Ｏｉで検出された歩行者の３次元位置と対応付けられた追跡器の各々について、対応する３次元位置ｙｉ，ｊを観測値として、その誤差分散行列ｒｉ，ｊと上記ステップＳ２００で得られた当該追跡器の歩行者の状態量及び分散共分散行列とを用いて、パーティクルフィルタのフィルタリングステップにより、状態量を更新すると共に、最後に観測した時刻を更新する。また、最新の観測Ｏｉで検出された歩行者の３次元位置のうち、追跡器と対応付かなかった歩行者の３次元位置に基づき、新たな状態量xを含む追跡器を生成し、最後に観測した時刻として、現在時刻を、移動物状態量記憶部１６に格納する。また、所定の存在確率を、移動物存在確率記憶部２２２に格納する。
【０１０３】
そして、ステップＳ１１８では、更新された状態量のセットＸを、歩行者の検出結果の統合結果として出力し、上記ステップＳ１０２へ戻る。
【０１０４】
ステップＳ１２０では、現時刻に対応して移動物状態量予測部１８によって複数の追跡器それぞれについて予測された状態量に基づいてサンプリングして得られる、歩行者の状態量を表す複数のパーティクルを、追跡器ぞれぞれに対して生成する。
【０１０５】
ステップＳ１２２において、複数の追跡器毎に、上記ステップＳ１２０で生成されたパーティクルの各々に対し、移動物可動範囲地図３０の尤度場ｍを用いて、地図尤度ωを算出する。
【０１０６】
ステップＳ１２４では、追跡器の各々について、上記ステップＳ１２０で生成されたパーティクルの各々と、上記ステップＳ１２２で求められた地図尤度ωとに基づいて、地図尤度ωを重みとする重み付き平均によって、当該追跡器の状態量を更新し、上記ステップＳ１０２へ戻る。
【０１０７】
以上説明したように、第２の実施の形態に係る歩行者状態量推定システムによれば、非同期に不特定の複数センサからセンシング結果が来る場合に、一つのセンサ情報から追加した状態量を、センサ性能等から決めた存在確率に基づいて削除することにより、信頼できない検出結果の影響が状態量として残らないようにすることで、各センサの誤検出にロバストになる。
【０１０８】
また、移動物可動範囲地図が、歩行者に関する精緻な情報を持つ場合には、移動物可動範囲地図が定める歩行者が位置することが可能な範囲を制約として用いて、予測された歩行者の状態量を修正する。このように、移動物可動範囲情報を移動物状態量の予測に直接反映させることで、より精度の高い整合処理が可能となる。
【０１０９】
［第３の実施の形態］
＜歩行者状態量推定システムのシステム構成＞
次に、第３の実施の形態に係る歩行者状態量推定システムについて説明する。なお、第１の実施の形態及び第２の実施の形態と同様の構成となる部分については、同一符号を付して説明を省略する。
【０１１０】
第３の実施の形態では、歩行者の存在確率を更新する際に、歩行者の可動範囲を考慮している点が第２の実施の形態と異なっている。
【０１１１】
図１１に示すように、第３の実施の形態に係る局地サーバ３１０は、通信部１２と、センシング結果獲得部１４と、移動物状態量記憶部１６と、移動物状態量予測部１８と、移動物状態量消去部１９と、移動物状態量整合部２０と、移動物状態量更新部２４と、移動物存在確率更新部３２０と、移動物存在確率記憶部２２２と、移動物可動範囲地図３０とを備えている。
【０１１２】
移動物存在確率更新部３２０は、移動物状態量整合部２０による追跡器と最新の観測の検出結果との対応付けの結果に基づいて、最新の観測の検出結果のうち、追跡器と対応付かなかった歩行者の検出結果に対し、上記第２の実施の形態と同様に、当該歩行者の存在確率として、設定値を移動物存在確率記憶部２２２に格納する。
【０１１３】
また、移動物存在確率更新部３２０は、移動物存在確率記憶部２２２に記憶されている複数の歩行者それぞれの存在確率のうち、移動物状態量整合部２０により最新の観測の検出結果と対応付けられた追跡器に対応する歩行者の存在確率の各々について、上記第２の実施の形態と同様に、検出器６０、６２について予め定められた検出精度に応じて増加させるように更新する。
【０１１４】
また、移動物存在確率更新部３２０は、移動物存在確率記憶部２２２に記憶されている複数の歩行者それぞれの存在確率のうち、移動物状態量整合部２０により最新の観測の検出結果と対応付けられなかった追跡器に対応する歩行者の存在確率の各々について、上記第２の実施の形態と同様に、最後に観測した時刻からの経過時間に応じた存在確率となるように減衰させて更新する。
【０１１５】
また、移動物存在確率更新部３２０は、移動物状態量記憶部１６に記憶されている歩行者の状態量に含まれる位置が、移動物可動範囲地図３０が定める歩行者が位置することが可能な範囲外である場合には、当該歩行者の存在確率を減少させるように更新する。
【０１１６】
なお、第３の実施の形態に係る歩行者状態量推定システムの他の構成及び作用は、第２の実施の形態と同様であるため、説明を省略する。
【０１１７】
このように、移動物可動範囲地図が定める歩行者が位置することが可能な範囲を制約として用いて、歩行者の存在確率を更新することにより、いない歩行者の状態量を適切に消去することができる。
【０１１８】
なお、上記の実施の形態では、検出対象となる移動物として歩行者を対象とする場合を例に説明したが、これに限定されるものではなく、例えば車両などの他の移動体を検出対象としてもよい。
【０１１９】
また、複数の車両に搭載された複数の検出器及びインフラセンサとしての検出器を、非同期の複数センサとする場合を例に説明したが、これに限定されるものではなく、インフラセンサとしての検出器を用いないように構成してもよい。
【０１２０】
また、単一の車両に搭載され、かつ、カメラ及びレーダを含む複数の計測器を用いた、複数の検出器を、非同期の複数センサとしてもよい。例えば、異なる計測器を用いた検出器が、後付けで当該車両に追加される場合には、複数センサの数が不定になることが想定される。
【０１２１】
また、パーティクルフィルタを用いて、状態量の予測及び更新を行う場合を例に説明したが、これに限定されるものではなく、カルマンフィルタを用いて、状態量の予測及び更新を行うようにしてもよい。
【０１２２】
なお、本発明のプログラムは、記録媒体に格納して提供することができる。
【符号の説明】
【０１２３】
１０、２１０、３１０ 局地サーバ
１２   通信部
１４   センシング結果獲得部
１６   移動物状態量記憶部
１８、２１８  移動物状態量予測部
１９   移動物状態量消去部
２０   移動物状態量整合部
２４   移動物状態量更新部
３０   移動物可動範囲地図
５０   基地局
６０、６２    検出器
７０   ネットワーク
１００ 歩行者状態量推定システム
２２０、３２０       移動物存在確率更新部
２２２ 移動物存在確率記憶部
【図１】
2018147157.tif 000024
【図２】
2018147157.tif 000025
【図３】
2018147157.tif 000026
【図４】
2018147157.tif 000027
【図５】
2018147157.tif 000028
【図６】
2018147157.tif 000029
【図７】
2018147157.tif 000030
【図８】
2018147157.tif 000031
【図９】
2018147157.tif 000032
【図１０】
2018147157.tif 000033
【図１１】
2018147157.tif 000034