(57)【要約】  物体状態変化手段（１０１）が、複数の物体に対して得られる複数の観測値と、物体状態情報記憶手段（１０３）に記録される最新の複数の物体状態との対応関係を計算し、物体状態の変化の有無を判定して、物体の状態変化があったときのみバッチ推定部（１０２）で高精度に物体の位置を推定する一方、物体の状態変化が無い間は、物体状態情報記憶手段（１０３）に記録されている高精度な物体の位置推定結果を物体位置推定結果として出力する。
2011108055.tif 000002
【特許請求の範囲】
【請求項１】
観測対象の観測空間に存在する１つの物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、前記物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記物体の前記観測空間内での存在状態及び前記物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段により、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と、
を備える物体位置推定装置。
【請求項２】
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段により、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と、
を備える物体位置推定装置。
【請求項３】
前記物体状態変化判定手段により、前記観測対象の前記物体が前記静止状態から移動状態に変化したと判定され、その後、前記移動状態から静止状態に変化したと判定されるまでの間は、前記バッチ推定手段が、前記当該物体の識別情報及び位置情報の推定を行わないとともに、推定値の出力も行わない、
請求項１又は２に記載の物体位置推定装置。
【請求項４】
前記物体状態変化判定手段により、前記観測対象の前記物体が移動状態から静止状態に変化したと判定され、その後、前記静止状態から移動状態に変化したと判定されるまでの間は、前記バッチ推定手段が、前記当該物体が前記静止状態に変化したと判定されたときに、前記当該物体の識別情報及び位置情報の推定を１度だけ行ったのち、その推定により得られた推定値を当該物体の物体状態情報として出力する、
請求項１又は２に記載の物体位置推定装置。
【請求項５】
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、物体状態変化判定手段により、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定ステップと、
前記物体状態変化判定ステップで前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、バッチ推定手段により、前記物体の識別情報及び位置情報の推定を行うバッチ推定ステップと、
を備える物体位置推定方法。
【請求項６】
コンピュータに、
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定機能と、
前記物体状態変化判定機能で前記物体の存在状態に変化があったと判定されたとき、物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定機能と、
を実現させるための物体位置推定プログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、センサなどの観測装置からの対象物体に関する観測値に基づいて、観測対象の空間内に存在する複数物体の位置を推定する物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムに関するものである。
【背景技術】
【０００２】
センサの観測値に基づいて物体の状態（例えば位置）を推定するための方式として、大きく分けて、逐次（オンライン）推定方式とバッチ（オフライン）推定方式とが存在する。【０００３】
逐次推定方式は、時系列的に得られる観測値を逐次的に処理する方式であり、観測値が得られる度に、即時、物体の状態推定値が得られ演算コストも少ないという特長がある。しかし、その反面、都度得られた観測値を頼りに推定を行うために、センサの観測誤差、あるいは、観測エラーの影響を受けやすく、外れ値が観測値として得られた場合には推定値の精度が著しく低下するという問題がある。【０００４】
一方、バッチ推定方式は、蓄積されたセンサ観測値を一括処理する方式であり、時系列的に得られた一連の複数の観測値を一括処理するため、一定期間の観測値が得られた後に始めて推定が可能になるという特徴がある。また、演算コストが大きいという問題はあるものの、観測誤差、あるいは、観測エラー等によって発生しうる外れ値による推定精度の低下に対して頑健であるという特長もある。【０００５】
センサの観測値に基づいて物体の状態を推定する従来技術として、逐次推定方式とバッチ推定方式の双方の特長を組み合わせる方式（特許文献１）がある。【０００６】
特許文献１では、逐次推定方式とバッチ推定方式の併用によって、人工衛星の位置の観測データから人工衛星の軌道を特定する装置・方法が開示されている。【０００７】
具体的には、１）バッチ推定により人工衛星の軌道を拘束する運動方程式のパラメータを推定する、２）その推定された運動方程式のパラメータを逐次推定のための初期値とする、３）逐次推定により人工衛星の位置を逐次推定する、という３つの処理ステップを基本サイクルとする。バッチ推定により推定された運動方程式のパラメータから人工衛星の推定位置に関する予測誤差が導かれるが、この予測誤差はバッチ推定が完了してからの時間経過に伴って増大する。あらかじめ定めた閾値を超えたタイミングで、前記基本サイクルを繰り返すことにより、バッチ推定の高精度推定という特長と、逐次推定の即時性という特長を組み合わせた方式である。
【先行技術文献】
【特許文献】
【０００８】
【特許文献１】特開２００１−１５３６８２号公報
【発明の概要】
【発明が解決しようとする課題】
【０００９】
しかしながら、特許文献１で開示されている方式では、ある１つの運動方程式で記述される時間経過に伴い位置が連続的に移動する物体の位置推定を前提としている。このため、静止と移動をランダムに繰り返すような準静止物体の位置推定に用いた場合、静止していることが分かっている状態においても逐次推定を行い続けることになる。準静止物体の位置推定に用いる場合として、運動方程式で記述できない状態であって例えば人が持ち運びするような物体の位置推定に用いた場合などが考えられる。このため、バッチ推定によって高精度に位置情報が得られたとしても、センサの観測誤差、観測エラーの影響を受けやすい逐次推定により位置推定結果の精度が下がってしまうという課題を有するものであった。【００１０】
また、特許文献１で開示されている方式では、観測対象が単体である物体、あるいは、観測対象物体が複数であっても観測した物体と観測値との対応関係が一意に定まる状況を前提としている。このため、観測値と観測された物体との対応関係が不定となる複数物体の位置推定には適用できないという課題を有するものであった。【００１１】
従って、本発明の目的は、前記問題を解決することにあって、静止と移動とをランダムに繰り返すような準静止物体の位置推定においても、推定位置の精度を高く維持することができ、かつ、観測値と観測された物体との対応関係が不定となる複数物体の位置推定にも適用できる、物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムを提供することにある。
【課題を解決するための手段】
【００１２】
前記課題を解決するために、本発明は以下のように構成される。【００１３】
本発明の第１態様によれば、観測対象の観測空間に存在する１つの物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、前記物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記物体の前記観測空間内での存在状態及び前記物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段が、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段とを備える物体位置推定装置を提供する。【００１４】
本発明の第２態様によれば、観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段により、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と、
を備える物体位置推定装置を提供する。【００１５】
本発明の第５態様によれば、観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、物体状態変化判定手段により、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定ステップと、
前記物体状態変化判定ステップで前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、バッチ推定手段により、前記物体の識別情報及び位置情報の推定を行うバッチ推定ステップと、
を備える物体位置推定方法を提供する。【００１６】
本発明の第６態様によれば、コンピュータに、
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定機能と、
前記物体状態変化判定機能で前記物体の存在状態に変化があったと判定されたとき、物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定機能と、
を実現させるための物体位置推定プログラムを提供する。
【発明の効果】
【００１７】
本発明の物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムによれば、複数の準静止物体（例えば、静止と移動を繰り返すような物体）の観測において、移動から静止へと物体の状態が変化があったと物体状態変化判定手段で判定したときから取得された観測値と物体状態変化判定手段が決定した物体の存在状態とに基づき、バッチ推定により物体の位置を高精度で確定した後は、物体が静止している間は、バッチ推定によって得た高精度の位置情報を推定情報として出力できるという格別の効果を有する。すなわち、従来技術において、静止していると分かっている物体についても逐次推定により位置推定を行うために発生する位置誤差の問題は、本発明では発生しない。【００１８】
さらに、本発明の物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムによれば、観測対象の物体の静止から移動、あるいは、移動から静止の状態変化を物体状態変化判定手段によって判断することにより、複数の物体すべてについて、観測中の任意の時刻における物体の静止、あるいは、移動の状態を把握することができるという効果も有す。
【図面の簡単な説明】
【００１９】
本発明のこれらと他の目的と特徴は、添付された図面についての好ましい実施形態に関連した次の記述から明らかになる。この図面においては、
【図１】図１は、本発明の第１様態の構成を示すブロック図であり、
【図２Ａ】図２Ａは、本発明の第１実施形態に係る、物体位置推定装置の構成例を示すブロック図であり、
【図２Ｂ】図２Ｂは、前記第１実施形態に係る前記物体位置推定装置の観測装置の一例である物体画像認識センサの構成を示すブロック図であり、
【図３】図３は、本発明の前記第１実施形態に係る前記物体位置推定装置を部屋に設置した例を示す図であり、
【図４】図４は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定において、観測対象の物体の一例としての物品の例を示す図であり、
【図５】図５は、本発明の前記第１実施形態に係る前記物体位置推定装置の観測値蓄積テーブルに記録された情報の一例を示す図であり、
【図６】図６は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品状態変化情報テーブルに記録された情報の一例を示す図であり、
【図７】図７は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品位置推定値テーブルに記録された情報の一例を示す図であり、
【図８】図８は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品位置表示ディスプレイの画面の表示例を示す図であり、
【図９】図９は、本発明の前記第１実施形態に係る前記物体位置推定装置の動作のフローチャートであり、
【図１０】図１０は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化の判定処理（ステップＳ２００）のフローチャートであり、
【図１１】図１１は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理のバッチ推定処理（ステップＳ５００）のフローチャートであり、
【図１２】図１２は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品位置表示ディスプレイの動作のフローチャートであり、
【図１３】図１３は、本発明の前記第１実施形態に係る前記物体位置推定装置の観測値蓄積テーブルに記録された情報の一部を示す図であり、
【図１４】図１４は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の時間変化と物体位置推定装置の動作シーケンスの変化を表したタイミングチャートであり、
【図１５】図１５は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化を判断するための尤度の計算例を示す図であり、
【図１６】図１６は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化を判断するための尤度の計算例を示す図であり、
【図１７】図１７は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化を判断するための尤度の計算例を示す図であり、
【図１８】図１８は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品状態変化情報テーブルに記録された情報の一例を示す図であり、
【図１９】図１９は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品位置推定値テーブルに記録された情報の一例を示す図であり、
【図２０】図２０は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化を判断するための尤度の計算例を示す図であり、
【図２１】図２１は、本発明の前記第１実施形態に係る、物品存在状態変化を判定するための尤度の計算例を示す図であり、
【図２２Ａ】図２２Ａは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｂ】図２２Ｂは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｃ】図２２Ｃは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｄ】図２２Ｄは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｅ】図２２Ｅは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｆ】図２２Ｆは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図。
【発明を実施するための形態】
【００２０】
以下に、本発明にかかる実施の形態を図面に基づいて詳細に説明する。
【００２１】
以下、図面を参照して本発明における実施形態を詳細に説明する前に、本発明の種々の態様について説明する。
【００２２】
本発明の第１態様によれば、観測対象の観測空間に存在する１つの物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、前記物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記物体の前記観測空間内での存在状態及び前記物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段が、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と
を備える物体位置推定装置を提供する。
【００２３】
本発明の第２態様によれば、観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段により、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と、
を備える物体位置推定装置を提供する。
【００２４】
本発明の第３態様によれば、前記物体状態変化判定手段により、前記観測対象の前記物体が前記静止状態から移動状態に変化したと判定され、その後、前記移動状態から静止状態に変化したと判定されるまでの間は、前記バッチ推定手段が、前記当該物体の識別情報及び位置情報の推定を行わないとともに、推定値の出力も行わない、
第１又は２の態様に記載の物体位置推定装置を提供する。
【００２５】
本発明の第４態様によれば、前記物体状態変化判定手段により、前記観測対象の前記物体が移動状態から静止状態に変化したと判定され、その後、前記静止状態から移動状態に変化したと判定されるまでの間は、前記バッチ推定手段が、前記当該物体が前記静止状態に変化したと判定されたときに、前記当該物体の識別情報及び位置情報の推定を１度だけ行ったのち、その推定により得られた推定値を当該物体の物体状態情報として出力する、
第１又は２の態様に記載の物体位置推定装置を提供する。
【００２６】
本発明の第５態様によれば、観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、物体状態変化判定手段により、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定ステップと、
前記物体状態変化判定ステップで前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、バッチ推定手段により、前記物体の識別情報及び位置情報の推定を行うバッチ推定ステップと、
を備える物体位置推定方法を提供する。
【００２７】
本発明の第６態様によれば、コンピュータに、
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定機能と、
前記物体状態変化判定機能で前記物体の存在状態に変化があったと判定されたとき、物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定機能と、
を実現させるための物体位置推定プログラムを提供する。
【００２８】
図１は本発明の前記第１様態にかかる物体位置推定装置の構成の一例を示すブロック図である。この第１様態にかかる物体位置推定装置は、物体観測値(物体の位置情報と識別情報)が入力される物体状態変化判定手段(物体状態変化判定部)１０１と、物体観測値(物体の位置情報と識別情報)と物体状態変化判定手段１０１からの出力情報が入力されるバッチ推定手段(バッチ推定部)１０２とを備えるように構成している。なお、この構成において、バッチ推定手段１０２からの出力情報が入力されるとともに物体状態変化判定手段１０１へ出力する物体状態情報記憶手段(物体状態情報記憶部)１０３をさらに備えるようにしてもよい。
【００２９】
本構成によって、物体状態変化判定手段１０１において、観測対象の観測空間に存在する物体の識別情報及び前記物体の位置情報を含む観測値の一例として観測空間内において複数の物体に対して得られる各々の観測値と、物体位置推定装置内で推定される物体各々の物体状態、例えば、最新の物体各々の物体状態との対応関係を計算する。計算の結果、対応する物体の存在状態に変化が有ったと判定された観測値、例えば、対応する物体状態が存在しないと判断された観測値がある場合は、観測空間内に新たに物体が出現した（あるいは観測可能状態になった）ことが判明する。反対に、対応する観測値が存在しないと判断された物体状態がある場合は、観測空間内において物体が消滅した（あるいは観測不可能状態になった）ことが判明する。
【００３０】
そして、観測空間内の物体の存在状態の変化が物体状態変化判定手段１０１で判定したときから取得された観測値（例えば、前記観測空間内の物体の存在状態の変化が物体状態変化判定手段１０１で判定されたタイミングから一定期間（一定回数）得られる複数の観測値）と、前記物体状態変化判定手段が決定した物体の存在状態とに基づきバッチ推定をバッチ推定手段１０２で行うことで、複数の観測値と物体との対応関係を考慮しつつ、各々の物体に関する位置推定を高精度で行うことができる。
【００３１】
さらに、物体状態変化判定手段１０１において、物体の存在状態の変化が無いと判定されている間は、このバッチ推定により高精度に推定された推定位置を物体状態情報記憶手段１０３に保持し最新の物体位置情報として維持し続けることもできるので、逐次推定で問題となる静止と移動をランダムに繰り返すような準静止物体などの位置推定における、観測装置の観測誤差、あるいは、観測エラーの影響による推定位置精度の低下を回避することができる。
【００３２】
以下に、本発明にかかる実施形態を図面に基づいて詳細に説明する。
【００３３】
（第１実施形態）
本発明の第１実施形態における物体位置推定装置２００は、観測空間の一例である生活空間などの室内を天井から、観測装置の一例である物品画像認識センサ２０９で撮影し、画像認識処理により物体の一例としての物品の位置検出処理及び物品の識別処理を行い、位置情報と識別情報とを含む観測情報に基づいて、物品の存在状態の変化を判定し、物品位置を推定するというものである。本実施形態では、物品画像認識センサ２０９の一例としてカメラを用いている。図２Ｂに示すように、物品画像認識センサ２０９は、撮像部２０９ａと、撮像部２０９ａで撮像された画像を画像認識処理する画像認識処理部２０９ｂと、撮像部２０９ａで撮像された画像及び画像認識処理部２０９ｂで処理された結果の情報などを記憶する記憶部２０９ｃとを備えている。
【００３４】
図２Ａは、本発明の第１実施形態における物体位置推定装置２００の構成を示すブロック図である。物体位置推定装置２００は、観測値取得部２０１と、観測値蓄積テーブル（観測値記憶部）２０２と、図１の物体状態変化判定手段１０１の一例として機能する物品状態変化判定部（物品状態変化判定手段）２０３と、図１の物体状態情報記憶手段１０３の一例として機能する物品状態変化情報テーブル（物品状態変化情報記憶部）２０４と、図１のバッチ推定手段１０２の一例として機能するバッチ推定部（バッチ推定手段）２０５と、図１の物体状態情報記憶手段１０３の一例として機能する物品位置推定値テーブル（物品位置推定値記憶部）２０６と、物品位置推定値出力部２０７と、時刻管理部２０８と、物品画像認識センサ２０９と、物品位置表示ディスプレイ（物品位置表示部）２１０と、物品位置表示操作用マウス（物品位置表示操作部）２１１とを備えるように構成される。
【００３５】
図３は、本発明の前記第１実施形態の物体位置推定装置２００の物品画像認識センサ２０９を、観測空間の一例である部屋３００に設置した例を示す。図３に示すように、物品画像認識センサ２０９は部屋３００の天井３０１に設置されている。なお、この部屋３００における位置を記述する座標系は、図３に示すように、部屋３００の床面３０２の北西角を原点とし、床面３０２の南方向にＸ軸、床面３０２の南方向にＹ軸、床面３０２の鉛直方向にＺ軸をそれぞれ取る直交座標系とする。以後の説明では、この座標系を部屋３００の世界座標系、又は、単に世界座標系と記述する。
【００３６】
物品画像認識センサ２０９は、図２Ｂに示すように、部屋３００の画像を撮影し撮影時刻毎に輝度値の２次元配列である撮像データを出力するカメラ部（撮像部）２０９ａと、カメラ部２０９ａにより出力された撮像データに対して画像認識処理を行う画像認識部２０９ｂとカメラ部２０９ａで撮像された画像及び画像認識処理部２０９ｂで処理された結果の情報などを記憶する内部記憶部２０９ｃとを備えるように構成されている。カメラ部２０９ａは、部屋３００の全体を撮影できる画角を有するものとする。
【００３７】
ここでは、物品画像認識センサ２０９が有するカメラ部２０９ａを構成するカメラの台数は１台とするが、複数のカメラを有していてもよい。たとえば、画角の小さいカメラを複数台用いて部屋３００の全体を撮影できるような構成でもよい。さらに、各カメラの撮影範囲が重複しており、同一の領域を複数方向から撮影できるような構成であってもよい。
【００３８】
画像認識部２０９ｂは、カメラ部２０９ａが出力する撮像データに対して、背景差分法により物品領域画像を抽出し、まず物品の位置を特定する。例えば、図２Ｂに示すように、カメラ部２０９ａで予め撮像して内部記憶部２０９ｂに記憶して用意しておいた、物品が存在していないときの部屋３００の背景画像データと、カメラ部２０９ａで撮像した現在の画像データとを、画像処理部２０９ｃで比較する。その後、画素値が異なる領域を差分領域として画像処理部２０９ｃで取り出す。この差分領域が、検出した物品に相当する。さらに、抽出した各物品領域画像に対して、識別すべき物品毎に予め用意されたテンプレート画像と照合を画像処理部２０９ｃで行うことにより、物品の種類を画像処理部２０９ｃで識別する。照合用のテンプレート画像は、内部記憶部２０９ｃに予め記録されているものとする。なお、物品の識別ないし位置特定のための画像認識処理については、他の方法でもよい。例えばＳＩＦＴ特徴量による物品識別アルゴリズムを用いることもできる。
【００３９】
物品画像認識センサ２０９が出力する観測値は、認識された物品の観測位置と、物品の種類ごとにあらかじめ割り振られた物品ＩＤに関して、観測した物品がどの物品であるかの確からしさである観測ＩＤ尤度とを組み合わせたデータである。
【００４０】
上述の物品ＩＤの一例を示す。例えば、図４に示すように、観測対象の物品が、コップ、リモートコントロール装置（リモコン）、ティッシュ箱、雑誌の４つであった場合、コップに対しては物品ＩＤ０００１を、リモコンに対しては物品ＩＤ０００２を、ティッシュ箱に対しては物品ＩＤ０００３を、雑誌に対しては物品ＩＤ０００４を割り当てるとする。どの物品に対して、具体的にどのＩＤ（図４の例では０００１〜０００４までの識別子）を割り当てるかについては、任意でよい。
【００４１】
図５は、後ほど説明する観測値蓄積テーブル２０２に記録される内容を例示したものであるが、図５で、物品画像認識センサ２０９の出力する観測値の例を示す。観測値の例として、ここでは、観測時刻（観測値を取得した時刻）ｔと観測ＩＤ尤度と観測位置（ＸＹＺ座標の値）とが記憶されている。図５の領域５０１（背景を灰色とした部分）のデータが、１つの物品に関する観測値（観測時間ｔ＝２７秒のときの観測ＩＤ尤度と観測位置とで構成される観測値）である。左から２番目から５番目までの４つのマス（物品ＩＤが０００１、物品ＩＤが０００２、物品ＩＤが０００３、物品ＩＤが０００４）の数値が観測ＩＤ尤度、右から３つ目のマス（観測位置のＸ座標の値、Ｙ座標の値、Ｚ座標の値）の数値が世界座標系での観測位置である。この観測値における観測位置は、物品画像認識センサ２０９の撮像した画像データの画像座標系における位置を世界座標系に変換した位置である。
【００４２】
なお、本第１実施形態では、部屋３００内の物品を観測する物品画像認識センサ２０９として、画像認識機能を備えた画像センサとしたが、観測対象の物品の位置、及び、種類の判別が可能であれば、画像センサ以外のセンサでもよい。例えば、物品画像認識センサ２０９の別の例として、ＲＦＩＤ、又は、レーザ距離センサ等、又は、複数の異種のセンサの組み合わせを用いてもよい。
【００４３】
図２Ａにおける観測値取得部２０１は、物品画像認識センサ２０９からの観測値を一定時間ごとに逐次取得し、時刻管理部２０８が保持する現在時刻を参照し、観測値を取得した時刻と観測値とを、観測値蓄積テーブル２０２に追加記録する。なお、本第１実施形態においては、観測値取得部２０１は、例えば１秒ごとのように、所定の周期で、観測値を取得するものとする。
【００４４】
観測値取得部２０１で、一度に取得される観測値は、観測できた物品の個数分の複数の観測値である。図５において、領域５０２で灰色背景の領域の観測値は、時刻ｔ＝２８秒に取得された複数の観測値（図５では４個の観測値）である。各観測値は、観測された結果としての観測ＩＤ尤度と観測位置との組で構成されている。
【００４５】
観測値取得部２０１は、観測値を観測値蓄積テーブル２０２に記録すると同時に、物品状態変化判定部２０３に出力する。
【００４６】
観測値蓄積テーブル２０２は、観測値取得部２０１で取得された観測値を観測時刻と共に蓄積する。図５に、蓄積された観測値のうち時刻ｔ＝２７〜３６秒に取得された観測値を示す。
【００４７】
図５は、真の位置の世界座標が、それぞれ（１２５，６５４，０），（２９６，３６２，６０），（３８，４９６，０），（３２１，７１５，７０）である４個の物品ＩＤ＝０００１〜０００４を観測した結果、得られた観測値を表す。時刻の単位は秒、位置の単位はセンチメートルである。図５において、時刻ｔ＝２９秒及び時刻ｔ＝３４秒においては、観測値が物品数分（ここでは４個分）得られていないが、物品画像認識センサ２０９において物品画像抽出に失敗したなど、観測値が欠損する場合があることを示している。
【００４８】
さて、物品画像認識センサ２０９は、画像認識により物品の識別を行うので、物品の識別誤りの可能性がある。この誤りの可能性を、「観測ＩＤ尤度」という数値で定量的に表現する。「観測ＩＤ尤度」の意味は、物品画像認識センサ２０９による物品の識別結果に関する物品ＩＤごとの確からしさの分布である。言い換えると、「観測ＩＤ尤度」は、観測値がどの物品を観測したかの確率分布を意味する。
【００４９】
図５の領域５０２の４つの観測値は、上から順に、物品ＩＤ＝０００１，物品ＩＤ＝０００２、物品ＩＤ＝０００３、物品ＩＤ＝０００４を観測した結果得られた観測値である。
【００５０】
領域５０２の上から１番目の観測値は、物品ＩＤ＝０００１の観測ＩＤ尤度の値が０．４で最も高く、他の物品ＩＤの観測ＩＤ尤度は、０．２である。観測値は、物品ＩＤ＝０００１を観測した観測値である確率が０．４であり、他の物品ＩＤ＝０００１以外の物品を観測した確率は、０．２であることを示す。
【００５１】
領域５０２の上から３番目の観測値は、物品ＩＤ＝０００３の観測ＩＤ尤度の値が０．７で最も高く、他の物品ＩＤの観測ＩＤ尤度は、０．１である。この観測値は、物品ＩＤ＝０００３を観測した観測値である確率が０．７であり、物品ＩＤ＝０００３以外の物品を観測した確率は、０．１であることを示す。
【００５２】
領域５０２の１番目の観測値が物品ＩＤ＝０００１を観測した確率（０．４）よりも、３番目の観測値が物品ＩＤ＝０００３を観測した確率（０．７）の方が高く、物品の識別の信頼性という意味からすると、１番目の観測値よりも３番目の観測値の方が信頼性が高いということになる。
【００５３】
識別する物品それぞれの画像的特徴、又は、物品間の画像的特徴の差、又は、物品を観測する空間の照明条件、又は、オクルージョンの状況（手前側に位置する物体で奥側に位置する物体が認識しにくくなっている状況）などによって、物品の認識間違いの状況は変わってしまう。そのため、理想的には、観測を行う度に、その観測条件を考慮して識別間違いの可能性を反映した観測ＩＤ尤度を算出すべきであるが、そのためには、事前にあらゆる観測条件を評価することが必要で、事実上、そのようなことは実行不可能である。
【００５４】
実用上は、ある一定の（あるいは、限定した複数の）観測条件の下で、物品の識別実験を行い、物品識別の正解率から物品ごとに観測ＩＤ尤度を求めておいて、実際に物品の位置推定を行う際に、求めておいた観測ＩＤ尤度を割り当てることで近似する。本第１実施形態においても、物品画像認識センサ２０９が出力する観測ＩＤ尤度は、実験により予め求められているものとする。
【００５５】
さて、次に、領域５０３に示す２つの観測値に注目すると、観測ＩＤ尤度の分布から、領域５０３の１番目の観測値は物品ＩＤ＝０００１を観測した可能性が最も高く、領域５０３の２番目の観測値は物品ＩＤ＝０００２を観測した可能性が最も高い、という結果である。
【００５６】
しかし、物品の真の位置に対する観測位置の誤差範囲を考慮すれば、実際は１番目の観測値は物品ＩＤ＝０００２を観測し、２番目の観測値は物品ＩＤ＝０００１を観測したことが分かる。
【００５７】
つまり、図５の領域５０３では、物品ＩＤ＝０００１と物品ＩＤ＝０００２とを取り違えて識別したケースを示している。ここで注意すべきことは、物品の識別間違いを含む観測値を特定する形で説明しているが、これは、物品の真の位置が分かっているとした場合のことであり、実際には、観測値だけからは物品の識別間違いが起こっているかどうかは分からないということである。
【００５８】
物品状態変化判定部２０３は、観測対象の室内（観測空間の一例）に存在する物体の識別情報及び物体の位置情報を含む観測値が逐次得られる度に、各物体の識別情報及び位置情報を含む観測値と、観測対象の各物体の室内での存在状態及び各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、室内での物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する。具体的には、物品状態変化判定部２０３は、観測値取得手段２０１が取得した観測値と、物品位置推定値テーブル２０６に保持された過去の物品位置の推定値から、「物品が取られた」、又は、「物品が置かれた」という物品の存在状態変化が起こったかどうかを、観測値を受け取る度に逐次判定する。
【００５９】
物品状態変化判定部２０３の動作については、後ほどフローチャートを用いて詳細に説明する。
【００６０】
物品状態変化判定部２０３で「物品の存在状態変化有」と判定された場合、判定に用いた観測値の観測時刻及び物品の存在状態判定結果を物品状態変化判定部２０３が物品状態変化情報テーブル２０４に追加記録する。
【００６１】
物品状態変化情報テーブル２０４は、物品状態変化判定部２０３で判定された物品状態変化情報（物品が置かれた、又は、物品が取られたなどの物品の存在状態の変化に関する情報）を、観測時刻と共に記録する。記録された情報の例を図６に示す。
【００６２】
図６においては、物品ＩＤごとに、物品が取られたことを「ＴＡＫＥ」 で表現し、物品が置かれたことを「ＰＵＴ」で表現している。空欄については、当該の物品に関しては存在状態変化が無いことを示している。
【００６３】
バッチ推定部２０５は、物体状態変化判定部２０３により、物体の存在状態に変化があったと判定されたとき、物体状態変化判定部２０３が物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、物体状態変化判定部２０３が決定した物体の存在状態とに基づき、物体の識別情報及び位置情報の推定を行う。具体的には、バッチ推定部２０５は、物品状態変化判定部２０３からの判定結果情報に基づき、物品状態変化判定部２０３が、「物品の存在状態変化有」と判定した時刻から、一定時間経過するまでに得られた観測値を、観測値蓄積テーブル２０２から受け取り、その複数時刻に渡る観測値群を入力として、バッチ推定処理を実行する。
【００６４】
バッチ推定部２０５の動作については後で説明する。
【００６５】
物品状態変化判定部２０３で判定された物品の存在状態変化の結果と、バッチ推定部２０５で推定された物品位置の結果における物品の存在状態とに矛盾があったということを、バッチ推定部２０５で判定した場合は、バッチ推定部２０５の物品位置推定結果に基づき、物品状態変化情報テーブル２０４の物品状態変化情報をバッチ推定部２０５が書き換える。バッチ推定部２０５で推定された、物品毎の世界座標系における推定位置は、時刻情報と共に物品位置推定値テーブル２０６に追加記録される。このとき、記録する時刻情報は、バッチ推定に用いた観測値群の中で最初の観測値の観測時刻を用いる。
【００６６】
物品位置推定値テーブル２０６は、バッチ推定部２０５で推定された物品毎の推定位置の情報を記録する。記録された情報の例を図７に示す。図７の表中における、数値が入っていない（ハイフンで表現した）部分は、物品が人などにより持ち運ばれており、物品の位置が推定できなかったことを示している。
【００６７】
物品位置推定値出力部２０７は、物品位置表示操作用マウス２１１から物品位置表示ディスプレイ２１０を介して、ある時刻における特定の物品の位置の情報を出力するよう要求を受けた場合に、物品位置推定値テーブル２０６に記録されている物品毎の位置情報の中で、当該時刻に最も近い過去の位置推定値を出力する。ただし、指定された物品の位置情報が無い場合、つまり、指定された物品が人などにより持ち運びされている状態の場合は、指定された物品の位置情報を出力する代わりに、「持ち運び中」であるという情報を物品位置推定値出力部２０７から出力する。
【００６８】
図７に示す例のように物品の推定位置が記録されていると仮定して、物品位置表示ディスプレイ２１０から物品位置推定値出力部２０７が時刻３００（ｓｅｃ）における物品ＩＤ＝０００１の位置の出力を要請された場合は、時刻３００（ｓｅｃ）に最も近い過去の時刻２５１（ｓｅｃ）での推定位置である（１２５．１，６５３．８，０．１）を物品位置推定値出力部２０７から物品位置表示ディスプレイ２１０に出力する。物品位置表示ディスプレイ２１０から物品位置推定値出力部２０７が時刻３００（ｓｅｃ）における物品ＩＤ＝０００２の位置の出力を要請された場合、時刻３００（ｓｅｃ）に最も近い過去の時刻２５１（ｓｅｃ）において、物品ＩＤ＝０００２が人などにより持ち運ばれており物品ＩＤ＝０００２に関してその位置が推定できていないので、「人により持ち運び中」であることを物品位置推定値出力部２０７から物品位置表示ディスプレイ２１０に出力する。  物品位置表示ディスプレイ２１０は、物品位置表示操作用マウス２１１などを使用してユーザから指定された各物品の位置情報を物品位置推定値出力部２０７に要求し、受け取った各物品の推定位置を画面上に表示する。
【００６９】
図８に物品位置表示ディスプレイ２１０の表示画面２１０ａの表示例を示す。矩形領域８０１は、部屋３００を天井３０１から床面３０２を見下ろしたときの平面座標系、すなわち、部屋３００の世界座標のＸＹ平面に対応する。矩形領域８０１の左上角が原点（Ｘ，Ｙ）＝（０，０）である。各物品の位置は、黒丸印「●」と物品のＩＤと、物品が置かれた時刻ｔと、物品位置のＸＹＺ座標とで示される。ここでは、一例として、時刻３００（ｓｅｃ）における物品位置が、図７の時刻２５１（ｓｅｃ）における各物品の推定位置に基づいて表示されている。
【００７０】
矩形領域８０２は、人などによって運搬されている物品（位置推定ができなかった物品、言い換えれば、位置情報が無い物品）のＩＤを表示する。図８の例では、物品ＩＤ＝０００２が、人などによって運搬されており、位置情報が無いことを示す。
【００７１】
矩形領域８０３では、ユーザが物品位置を知りたい時刻を設定する。ユーザは、物品位置表示操作用マウス２１１を操作し、表示画面２１０ａ内のマウスポインタ８０４を動かして、矩形領域８０３の「戻る」ボタン、あるいは、「進む」ボタンをクリックすることによって、矩形領域８０３の右端に表示される時刻ｔの値を増減させることで、物品位置を知りたい時刻を指定する。
【００７２】
物品位置表示ディスプレイ２１０は、ユーザが、物品位置表示操作用マウス２１１を操作して物品位置を知りたい時刻を設定する度に、物品位置推定値出力部２０７に、当該時刻における物品の位置情報を要求し、物品位置推定値出力部２０７から物品位置推定値を受け取り、矩形領域８０１と矩形領域８０２にそれぞれ、各物品の位置と、人などによって運搬されている物品のＩＤとを表示する。
【００７３】
以後、物体位置推定装置２００の動作を、図９、図１０、及び、図１１のフローチャートを用いて詳細に説明する。
【００７４】
これ以降の物体位置推定装置２００の動作の説明では、物品の存在状態変化が図１４に示すタイミングチャートの上半分のチャート１４Ａのように起こったとものとして説明を進める。この物品の存在状態変化のタイミングチャートであるチャート１４Ａの縦軸は位置を表し、横軸は時間を表す。位置に関しては、説明の簡略化のために１次元で表している。物品ＩＤ＝０００１から物品ＩＤ＝０００４までの４個の物品の真の位置を実線の矢印で表し、物品が例えば人により持ち運ばれている状態を破線の矢印で表している。
【００７５】
物品は、人によって持ち運ばれるとき以外は静止しているので、チャート１４Ａでは、物品位置は位置軸に直交した直線で表現される。一方、物品が人によって持ち運ばれている間は任意の動きになるが、持ち運ばれている間の物品の位置は推定の対象外としているので、チャート１４Ａでは便宜上（破線）直線で表現している。
【００７６】
チャート１４Ａにおいて、物品存在状態変化があった（物品が「取られた」又は「置かれた」）時刻及び位置は、白丸の「○」印で表示し、物品が置かれた場合は白丸の「○」印中に「Ｐ」を表示し、物品が持ち去られた場合は白丸の「○」印中に「Ｔ」を表示している。
【００７７】
チャート１４Ａは、時刻ｔ１に物品ＩＤ＝０００４が置かれ、時刻ｔ５に物品ＩＤ＝０００４が取られ、時刻ｔ８に物品ＩＤ＝０００１と物品ＩＤ＝０００２とが取られ、時刻ｔ１１に物品ＩＤ＝０００１が置かれ、時刻ｔ１４に物品ＩＤ＝０００４が置かれるという物品の存在状態変化を表現している。時刻ｔ１からｔ１６までの間、物品ＩＤ＝０００３は何も存在状態が変化していないことを示している。
【００７８】
図１４に示す物品の存在状態変化に応じて、時刻ｔ１，ｔ４，ｔ５，ｔ８，ｔ１１，ｔ１４における物品の観測値は、図１３のとおり得られたものとする。
【００７９】
図９は、物体位置推定装置２００の動作フローを表すフローチャートである。ここでの動作の大まかな流れは、物品の観測値を得て、その観測値と物品の最新の推定位置とから、物品の存在状態変化があったかどうかを判定し、存在状態変化があった場合のみ、バッチ推定により、新たに位置の推定を行い、推定位置を記録するというものである。
【００８０】
図９におけるステップＳ１００の観測値取得処理は、図２Ａの物体位置推定装置２００における観測値取得部２０１により実行される動作に対応する。ステップＳ１００では、観測値取得部２０１が、図２Ａ及び図２Ｂの物品画像認識センサ２０９から出力される観測値を取得し、時刻管理部２０８から得た現在時刻を、観測時間として、この観測時間と観測値とを、観測値蓄積テーブル２０２に記録するとともに物品状態変化判定部２０３に出力する。
【００８１】
次に、ステップＳ２００の物品状態変化判定処理が、図２Ａの物体位置推定装置２００における物品状態変化判定部２０３により実行される。
【００８２】
ステップＳ２００の内部処理について、図１０のフローチャートを用いて説明する。
【００８３】
図１０のフローチャートにおいて、ステップＳ２０１からステップＳ２０２までの処理は、新たな物品が観測されたか、あるいは、置かれている物品が観測されなかったかという基準で、物品の存在状態変化があったかどうかを物品状態変化判定部２０３で判定する処理である。
【００８４】
ステップＳ２０３からステップＳ２０６は、物品が新たに置かれたときにどの物品が置かれたかを物品状態変化判定部２０３で判定する処理である。
【００８５】
ステップＳ２０７からステップＳ２０９は、物品が取られたときにどの物品が取られたかを物品状態変化判定部２０３で判定する処理である。
【００８６】
ステップＳ２１０は、物品の存在状態変化がなかったときの物品状態変化判定部２０３での処理である。  ステップＳ２０１では、現時刻において観測値取得部２０１から得られた複数の観測値と、物品位置推定値テーブル２０６に記録されている現時刻における最新の物品毎の物品位置推定値との、すべての組み合わせに対して、以下の（式１）で定義されるアソシエーション尤度を物品状態変化判定部２０３で計算する。物品位置推定値の数をＮとし、得られている観測値の数をＭとすると、Ｍ×Ｎ個のアソシエーション尤度を物品状態変化判定部２０３で計算することになる。
【００８７】
【数１】
2011108055.tif 000003
【００８８】
アソシエーション尤度は、実際の物品と観測値との対応の確からしさを表す値であり、確率論として数学的に定式化できる。（式１）の左辺において、物品位置推定値の数をＮとすると、ＸはＮ個分の物品位置推定値の結合ベクトルであり、ｙは、観測ＩＤ尤度ｙＩＤと観測位置ｙｐｏｓを結合した観測値のベクトルである。ｒは、ｙがＮ個の物品のうち、どの物品を観測したかを表す状態変数で、ｒ＝ｊの場合物品ＩＤがｊの物品を観測したということを意味する。（式１）の左辺は、ある物品位置推定値ベクトルＸが与えられ、物品ｊを観測したとしたときに、観測値ベクトルｙが得られる条件付き確率である。
【００８９】
（式１）の右辺ｐｐｏｓ（ｙｐｏｓ｜Ｘ，ｒ＝ｊ）は、観測値ベクトルｙの観測位置であるｙｐｏｓのｊ番目の物品の位置に対する尤度を表している。そして、（式１）の右辺のｐＩＤ（ｙＩＤ｜Ｘ，ｒ＝ｊ）は、観測値のうち観測ＩＤ尤度に相当する項である。本第１実施形態では、このように（式１）の右辺で表現している通り、物品の位置の尤度と観測ＩＤ尤度とは互いに独立とするモデルにより、定式化する。
【００９０】
【数２】
2011108055.tif 000004
【００９１】
（式２）は、（式１）のｐｐｏｓ（ｙｐｏｓ｜Ｘ，ｒ＝ｊ）を定義する式である。本第１実施形態においては、物品画像認識センサ２０９の位置誤差特性は、３次元の正規分布で近似できるものとする。（式２）において、ｄは位置の座標の次元数でありｄ＝３である。ｘは物品ＩＤがｊである物品の推定位置の３次元座標値、ｙｐｏｓは観測値の観測位置の３次元座標値を表す。Σは３×３の行列で物品画像認識センサ２０９の位置誤差特性を表す共分散行列である。特に、各次元の位置誤差の間に相関がない場合は、対角成分が各次元の誤差の分散となる対角行列となる。このΣについては、物品画像認識センサ２０９で物品の位置計測実験を予め行って求めておく。
【００９２】
【数３】
2011108055.tif 000005
【００９３】
（式３）は（式１）のｐＩＤ（ｙＩＤ｜Ｘ，ｒ＝ｊ）を定義する式である。ここでＣｊは、物品画像認識センサ２０９の物品ＩＤがｊの物品に関する識別率である。また、Ｎは観測の対象となる物品の数である。本第１実施形態では、観測ＩＤ尤度が（式３）の式で定式化されているものとする。すなわち、物品ＩＤがｊの物品を観測した際には、観測ＩＤ尤度の物品ＩＤがｊに関する尤度は、Ｃｊであり、物品ＩＤがｊではない物品ＩＤに関する尤度は、（１−Ｃｊ）／（Ｎ−１）で得られるとする。この定義では、物品ＩＤがｊ以外の物品を観測したときに、物品ＩＤがｊの物品であると誤識別する確率は、物品ＩＤがｊ以外の物品に関して、すべて同じであるとして扱っている。Ｃｊの値については、物品画像認識センサ２０９に関する説明で述べた通り、物品画像認識センサ２０９で物品の識別実験を予め行って求めておく。
【００９４】
図１５，図１６、及び、図１７にステップＳ２０１で計算したアソシエーション尤度の例を示す。
【００９５】
図１５は、物品ＩＤ＝０００４が置かれた時刻ｔ１における計算結果である。具体的には、現時刻が時刻ｔ１であるとすると、図１３の時刻ｔ１での観測値１３０１と、図１９の、時刻ｔ１における最新の時刻である時刻ｔ０での物品位置推定値との組み合わせに関して計算される。なお、図１９の時刻ｔ０は図１４のチャート１４Ａには記載されていないが、時刻ｔ０は、時刻ｔ１より前の時刻であって、物品ＩＤ＝０００４が取られた際にバッチ推定によって得られた物品位置推定値が記録された時刻である。
【００９６】
図１６は、物品の存在状態変化が無い時刻ｔ４における計算結果である。図１３の時刻ｔ４における観測値１３０２と、時刻ｔ４より前の図１９の時刻ｔ１における物品位置推定値との組み合わせに関して計算される。
【００９７】
図１７は、物品ＩＤ＝０００４が持ち去られた時刻ｔ５における計算結果である。図１３の時刻ｔ５における観測値１３０３と、時刻ｔ５より前の図１９の時刻ｔ１における物品位置推定値との組み合わせに関して計算される。
【００９８】
ステップＳ２０２では、ステップＳ２０１で尤度を計算するのに用いた観測値数Ｍと物品位置推定値数Ｎとを物品状態変化判定部２０３で比較して、条件分岐を行う。
【００９９】
条件分岐の内容は、
１）Ｍ＞Ｎの場合は、ステップＳ２０３に進む（新たに物品が置かれた場合）、
２）Ｍ＝Ｎの場合は、ステップＳ２１０に進む（物品の存在状態に変化が無い場合）、
３）Ｍ＜Ｎの場合は、ステップＳ２０７に進む（物品が取られた場合）、
の３つである。図１４の時刻ｔ１，ｔ４，ｔ５においてアソシエーション尤度を計算した結果が、それぞれ図１５，図１６，図１７である。ステップＳ２０２において、時刻ｔ１ではＮ＝３，Ｍ＝４で前記１）の条件分岐になり、時刻ｔ４ではＮ＝４，Ｍ＝４で前記２）の条件分岐になり、時刻ｔ５ではＮ＝４，Ｍ＝３で前記３）の条件分岐となる。
【０１００】
次に、新たに物品が置かれた場合の処理に相当するステップＳ２０３からステップＳ２０６までの処理について説明する。処理の具体例として、図１５に示す時刻ｔ１における尤度の計算結果に基づいて説明する。
【０１０１】
ステップＳ２０３からステップＳ２０６までの処理の流れをまず簡単に説明すると、ステップＳ２０３とステップＳ２０４とで、現在置かれている物品には対応しない観測値が、どの観測値であるか、を物品状態変化判定部２０３で決定する。次に、ステップＳ２０５で、物品に対応しない観測値が、どの物品を観測したものであるか、を物品状態変化判定部２０３で決定し、ステップＳ２０６で物品存在状態判定結果として物品状態変化判定部２０３から出力する、というものである。
【０１０２】
ステップＳ２０３では、ステップＳ２０１で計算した尤度に対して物品位置推定値の物品ＩＤを固定した上で、アソシエーション尤度の大きさの順序を物品状態変化判定部２０３で決定する。例えば、物品状態変化判定部２０３により、図１５の尤度の計算結果の表の列方向に尤度の大きさを比較して順序を決定する。
【０１０３】
次いで、ステップＳ２０４では、物品状態変化判定部２０３により、ステップＳ２０３でアソシエーション尤度の順序を決定した後、どの物品ＩＤに関してもアソシエーション尤度が最大とならない観測値を特定する。
【０１０４】
図１５のアソシエーション尤度の計算結果の表では、背景が灰色の箇所１５０１，１５０２，１５０３が、ステップＳ２０３で順序を決定した結果、最大となったアソシエーション尤度である。ここで、観測値１は、物品ＩＤ＝０００１の位置推定値に関してアソシエーション尤度が最大である（図１５の１５０１の欄参照）。観測値２は、物品ＩＤ＝０００２の位置推定値に関してアソシエーション尤度が最大である（図１５の１５０２の欄参照）。観測値３は、物品ＩＤ＝０００３の位置推定値に関してアソシエーション尤度が最大である（図１５の１５０３の欄参照）。しかし、観測値４は、どの物品に関しても、最大となるアソシエーション尤度がない。よって、観測値４が、ステップＳ２０４で特定される観測値となると物品状態変化判定部２０３により判定する。
【０１０５】
次いで、ステップＳ２０５では、ステップＳ２０４で特定された観測値の観測ＩＤ尤度の中で最も尤度が高い物品ＩＤを物品状態変化判定部２０３により特定する。
【０１０６】
図１５のアソシエーション尤度の計算結果に基づいて、ステップＳ２０４では観測値４が特定されている。観測値４は、図１３の中の１３０１の観測値の上から４番目の観測値であり、観測ＩＤ尤度が最大の物品ＩＤは０００４である。従って、ステップＳ２０５では物品ＩＤが０００４と物品状態変化判定部２０３により特定される。
【０１０７】
次いで、ステップＳ２０６では、ステップＳ２０５で特定された物品ＩＤを持つ物品が、「新たに置かれた物品である」ことが、物品状態変化判定部２０３により決定され、ステップＳ２００の出力として「当該物品ＩＤが置かれた」という物品存在状態変化判定結果を、物品状態変化判定部２０３が出力する。
【０１０８】
図１５のアソシエーション尤度の計算結果に基づくと、ステップＳ２０３からステップＳ２０６の一連の処理の結果として、物品状態変化判定部２０３は、物品ＩＤが０００４の物品がＰＵＴされたこと（置かれたこと）を出力する。
【０１０９】
次に、物品存在状態に変化が無い場合に相当するステップＳ２１０の処理について説明する。ここでは物品状態変化判定部２０３の出力として、物品存在状態変化なしを出力する。図１４の時刻ｔ４の時点では、物品の存在状態変化が無かったと判定される。
【０１１０】
次に、物品が取られた場合に相当するステップＳ２０７からステップＳ２０９までの処理について説明する。処理の具体例として、図１７に示す時刻ｔ５における尤度の計算結果に基づいて説明する。
【０１１１】
ステップＳ２０７からステップＳ２０９までの処理の流れをまず簡単に説明すると、ステップＳ２０７とステップＳ２０８とで、得られた観測値と対応しない物品が、どの物品か、を物品状態変化判定部２０３で決定する。次に、ステップＳ２０９では、ステップＳ２０８で決定した、物品ＩＤが取られたという物品存在状態判定結果を物品状態変化判定部２０３から出力するというものである。
【０１１２】
ステップＳ２０７では、ステップＳ２０１で計算したアソシエーション尤度に対して、観測値を１つに固定した上で、アソシエーション尤度の大きさの順序を物品状態変化判定部２０３で決定する。例えば、物品状態変化判定部２０３により、図１７のアソシエーション尤度の計算結果の表の行方向に尤度の大きさを比較し順序を決定する。
【０１１３】
次いで、ステップＳ２０８では、物品状態変化判定部２０３により、ステップＳ２０７でアソシエーション尤度の順序を決定した後、どの観測値に関してもアソシエーション尤度が最大とならない物品ＩＤを特定する。
【０１１４】
図１７の例で説明すると、背景が灰色の箇所１７０１，１７０２，１７０３が、ステップＳ２０７で順序を決定した結果、最大となったアソシエーション尤度である。ここで、物品ＩＤ＝０００１の位置推定値は、観測値１に関してアソシエーション尤度が最大である（図１７の１７０１の欄参照）。物品ＩＤ＝０００２の位置推定値は、観測値２に関してアソシエーション尤度が最大である（図１７の１７０２の欄参照）。物品ＩＤ＝０００３の位置推定値は、観測値３に関してアソシエーション尤度が最大である（図１７の１７０３の欄参照）。しかし、物品ＩＤ＝０００４の位置推定値は、どの観測値に関しても、最大となるアソシエーション尤度がない。よって、物品ＩＤの０００４が、ステップＳ２０８で特定される物品ＩＤとなると物品状態変化判定部２０３により判定する。
【０１１５】
次いで、ステップＳ２０９では、ステップＳ２０８で特定された物品ＩＤを持つ物品が、「取られた物品である」と物品状態変化判定部２０３により決定し、ステップＳ２００の出力として「当該物品ＩＤが取られた」という物品存在状態変化判定結果を、物品状態変化判定部２０３から出力する。
【０１１６】
図１７のアソシエーション尤度の計算結果に基づくと、ステップＳ２０７からステップＳ２０９の一連の処理の結果として、物品状態変化判定部２０３は、物品ＩＤが０００４の物品がＴＡＫＥされた（取られた）ことを出力する。
【０１１７】
以上が、ステップＳ２００の物品状態変化判定処理の説明である。  再び、図９のフローチャートに戻り物体位置推定装置２００の処理ステップの説明を続ける。
【０１１８】
ステップＳ２００に続くステップＳ３００では、ステップＳ２００の処理で、物品存在状態の変化があると物品状態変化判定部２０３で判定された場合は、ステップＳ４００へ分岐し、物品存在状態の変化がないと物品状態変化判定部２０３で判定されれば、ステップＳ１００に戻る。
【０１１９】
ステップＳ４００では、ステップＳ２００で物品状態変化判定部２０３により決定された、物品状態変化判定部２０３からの物品存在状態変化の判定結果の出力に応じて、物品状態変化判定部２０３により物品状態変化情報テーブル２０４に物品存在状態の変化を記録する。記録する内容は、物品状態変化情報テーブル２０４の説明のとおりである。
【０１２０】
ステップＳ５００は、物品存在状態に変化があった場合に、バッチ推定部２０５が行う物品位置のバッチ推定処理である。
【０１２１】
ステップＳ５００の内部の処理フローを、図１１のフローチャートで説明する。
【０１２２】
図１１のステップＳ５０１においては、まず、物品状態変化があったと物品状態変化判定部２０３で判定された際に取得された時刻から、あらかじめ定められた時間の間、観測値取得部２０１で観測値を取得し、観測値蓄積テーブル２０２に観測値を記録するよう、バッチ推定部２０５が観測値取得部２０１に指令する。
【０１２３】
なお、ここで、観測値を取得する時間（あるいは、取得する回数）については、実験により所望の位置精度（位置に関するバラツキの上限）が予め得られるように、また、バッチ処理による位置推定処理が完了するまでの時間が、対象とする物品の状態変化の頻度上、問題とならない範囲になるように定めるものとする。
【０１２４】
例えば、本第１実施形態における物体位置推定装置２００で、位置の推定対象とする物品に関して、物品を静止状態にした上で、物品画像認識センサ２０９から観測値を観測値取得部２０１で取得する時間を変化させた上で（あるいは、観測値を取得する回数を変化させた上で）、バッチ推定部２０５でバッチ推定処理を行わせ、必要とする位置精度が得られる最小の観測値の取得時間（例えば数秒、あるいは、最小の観測値の取得回数）を、一定の時間（あるいは回数）と定める。
【０１２５】
ステップＳ５０２では、ステップＳ２００で物品状態変化があったことを判定した際に用いた観測値と、ステップＳ５０１で一定時間、複数回取得した観測値とを合わせて観測値蓄積テーブル２０２から取得し、バッチ推定部２０５により、バッチ推定による物品位置推定を行う。
【０１２６】
バッチ推定の方法としては、複数の物品と複数の観測値との対応関係を確率的に取り扱うことが可能な推定アルゴリズムを用いる。バッチ推定部２０５による推定アルゴリズムの一例としては、例えば（非特許文献１：Hirofumi Kanazaki，Takehisa Yairi，Junichi Shibata，Yohei Shirasaka and Kazuo Machida，"Localization and Identification of Multiple Objects with Heterogeneous Sensor Data by EM Algorithm"，SICE-ICASE International Joint Conference (SICE-ICCAS) 2006）で開示されている方法を用いることができる。本第１実施形態では、物品画像認識センサ２０９で得られる観測値に、物品の識別に関する尤度（観測ＩＤ尤度）を含むので、前記非特許文献１で開示されているデータアソシエーションの枠組みを組み込んだＥＭアルゴリズムを適用することが可能である。
【０１２７】
ここで、非特許文献１で開示されているアルゴリズムを用いたバッチ推定処理の概要について、補足説明する。
【０１２８】
以下の補足説明において、ＸはＮ個分の物品位置推定値の結合ベクトルであり、ｘｊ，ｐｏｓは、ｊ番目の物品推定位置とする。Ｙは、バッチ推定の入力となるＭ個の観測値の結合ベクトルであり、i番目の観測値をｙiとする。ｙiは、観測ＩＤ尤度ｙＩＤと観測位置ｙｐｏｓを結合した観測値のベクトルとする。さらに、ｒｊは観測値ｙiがどの物品を観測したかを表わす状態変数である。（例えばｒｉ＝ｊである場合は、観測値ｙiは、ｊ番目の物品を観測したという状態を表す。）なお、ここでのＸ，Ｙ、ｒに関する定義は、本実施形態における物品位置の推定値、物品の観測値（物品ＩＤ尤度、および、観測値）、観測値がどの物品を観測したかを表す状態変数の定義と同じ意味であるので、以下説明する具体的なバッチ推定アルゴリズムを、本実施形態でのバッチ推定部２０５のバッチ推定方式として使えることを述べておく。
【０１２９】
以下説明するバッチ推定アルゴリズムは、ＭＡＰ推定法（事後確率最大化推定法）と呼ばれるものであり、ｐ（Ｘ｜Ｙ）で表される確率を最大化するＸの値（Ｘ＝Ｘ＊）を求めることにより、Ｘすなわち、物品位置の推定を行うものである。
【０１３０】
【数４】
2011108055.tif 000006
【０１３１】
この（式４）のＭＡＰ推定で得られるＸ＊の意味するところは、観測データＹを得た時、Ｘ＝Ｘ＊において、ｐ（Ｘ｜Ｙ）が最大になるとすれば、Ｘ＊が最も確からしいＸの値であることである。すなわち、Ｘ＊が物品位置として尤も確からしい位置を与えることになる。
【０１３２】
ベイズの定理により、ｐ（Ｘ｜Ｙ）は、次のように変形される。
【０１３３】
【数５】
2011108055.tif 000007
【０１３４】
（式５）のように変形した上で、ＭＡＰ推定をＥＭアルゴリズムによって行う。ＥＭアルゴリズムは、Ｅ−Ｓｔｅｐ（推定ステップ）,Ｍ−Ｓｔｅｐ（最大化ステップ）という２つの計算ステップを繰り返すことにより、ＭＡＰ推定を実行するアルゴリズムである。Ｘ（ｔ）を、ＥＭアルゴリズムの繰り返し計算のｔ番目の計算によって得られた物品位置Ｘの推定値であるとする。（式５）のように変形されたｐ（Ｘ｜Ｙ）のＭＡＰ推定を行うＥＭアルゴリズムを以下に示す。
【０１３５】
【数６】
2011108055.tif 000008
【０１３６】
ここで、本実施形態の（式１）の定義から、ｐ（ｙｉ｜Ｘ，ｒｉ＝ｊ）＝ＰＩＤ（ｙｉ，ＩＤ｜Ｘ，ｒｉ＝ｊ）・ｐｐｏｓ（ｙｉ，ｐｏｓ｜ｒｉ＝ｊ）となるので、（式６）に代入すると、
【０１３７】
【数７】
2011108055.tif 000009
【０１３８】
となる。この変形において、Ｎ個の物品は同じ頻度で観測されるので、（式６）においてｐｐｏｓ（ｒｉ，ｐｏｓ｜Ｘ）＝１／Ｎとおいた。
【０１３９】
（式７）のＱ（Ｘ｜Ｘ（ｔ））に関して、（式６）のＭ−Ｓｔｅｐすなわち、Ｑ（Ｘ｜Ｘ（ｔ）が最大になるＸを求めるために、
【０１４０】
【数８】
2011108055.tif 000010
【０１４１】
を解くことで、
【０１４２】
【数９】
2011108055.tif 000011
【０１４３】
を得る。
【０１４４】
さらに、（式６）のαに関して、
【０１４５】
【数１０】
2011108055.tif 000012
【０１４６】
を得る．この変形においてもｐｐｏｓ（ｙｉ，ｐｏｓ｜Ｘ）＝１／Ｎとおいた。なお、（式９）の右辺は本実施形態の（式１）、（式２）、（式３）において、Ｘ＝Ｘ（ｔ＋１）代入することにより得られる。ここで得られた（式８）、（式９）がＸ（ｔ）からＸ（ｔ＋１）を求める更新式であり、この更新式に基づいた繰り返し計算により、Ｘ＊を求めることができる。
【０１４７】
この繰り返し計算における物品推定位置の初期値は、Ｘ（０）として与える。
【０１４８】
前記ステップＳ５０２でバッチ推定を開始する際の、物品位置推定の初期値の与え方について説明する。
【０１４９】
新たに物品が置かれた場合、存在状態変化の無かった物品については、物品位置推定値テーブル２０６に記録されている最新の物品位置推定値を物品位置推定の初期値としてバッチ推定部２０５で用いる。新たに置かれた物品に関する物品位置推定処理での推定位置の初期値としては、ステップＳ２０４で特定された観測値の観測位置をバッチ推定部２０５で用いる。物品が取られた場合は、取られた物品以外の物品を存在状態変化が無かったとして、バッチ推定部２０５で扱う。
【０１５０】
ステップＳ５０３では、ステップＳ５０２で得られた各物品の推定位置をバッチ推定結果としてバッチ推定部２０５から出力する。
【０１５１】
以上が、ステップＳ５００でのバッチ推定部２０５が行う物品位置のバッチ推定処理の説明である。
【０１５２】
再び、図９のフローチャートに戻る。
【０１５３】
ステップＳ５００に続くステップＳ６００は、ステップＳ５００においてバッチ推定部２０５の推定結果から判明する物品の存在状態と、ステップＳ２００において物品状態変化判定部２０３で判定した物品の存在状態との間に矛盾が生じているかをバッチ推定部２０５で判定する。
【０１５４】
ステップＳ６００において、矛盾が生じているとバッチ推定部２０５で判定された場合は、ステップＳ７００において、バッチ推定部２０５から得た推定結果に基づき、バッチ推定部２０５により、物品状態変化情報テーブル２０４内の物品の存在状態を書き換える。
【０１５５】
ここで、ステップＳ６００におけるバッチ推定部２０５での判定処理、及び、ステップＳ７００におけるバッチ推定部２０５による物品状態変化情報テーブル２０４内の物品の存在状態の書き換えが必要な理由を説明する。
【０１５６】
ステップＳ２００において物品が追加されたときの処理フローの中のステップＳ２０５において、既に存在する物品に対応しない観測値の観測ＩＤ尤度で最大の物品ＩＤを追加された物品のＩＤであると物品状態変化判定部２０３で特定している。このとき、一時的なオクルージョン又は観測する空間の照明の変動などの物品観測上の外乱により、物品画像認識センサ２０９が物品の識別誤りを起こす可能性がある。識別誤りを起こした場合は、本当に追加された物品ＩＤではない物品ＩＤの尤度が高くなり、その結果、ステップＳ２００において物品状態変化判定部２０３は、誤った物品ＩＤの物品が追加された物品であると誤って判定し、ステップＳ４００において、物品状態変化情報テーブル２０４に誤った物品ＩＤの物品がＰＵＴされたと、物品状態変化判定部２０３により記録されてしまう。
【０１５７】
しかし、ステップＳ５００において、バッチ推定部２０５により一定時間内の複数の観測値に基づいて物品位置の推定処理を行うので、一時的な外乱による物品の識別誤りの影響が抑えられ、最終的に正しい物品ＩＤの物品が追加されたことがバッチ推定部２０５により判明する。
【０１５８】
したがって、ステップＳ６００において、ステップＳ５００のバッチ推定処理により得られた正しい物品の存在状態と、物品状態変化情報テーブル２０４に記録された物品の存在状態とをバッチ推定部２０５で比較し、両者が異なるとバッチ推定部２０５で判定した場合は、ステップＳ７００において、物品状態変化情報テーブル２０４の内容をステップＳ５００のバッチ推定処理の結果に基づいてバッチ推定部２０５が書き換える。
【０１５９】
ステップＳ６００で、前記したように矛盾が発生し、ステップＳ７００で書き換えを行う具体例については、後で詳しく説明する。
【０１６０】
ステップＳ６００で矛盾がないとバッチ推定部２０５で判定された場合、又は、ステップＳ７００において、物品状態変化情報テーブル２０４の内容をステップＳ５００のバッチ推定処理の結果に基づいてバッチ推定部２０５が書き換えた後は、ステップＳ８００に進む。
【０１６１】
ステップＳ８００は、ステップＳ５００でバッチ推定部２０５により推定された物品毎の物品位置推定値を、物品位置推定値テーブル２０６にバッチ推定部２０５により記録する。記録される位置推定値については、物品位置推定値テーブル２０６の説明で述べた通りである。ステップＳ８００の処理の後は、一連の物体位置推定処理動作を終了するか、又は、図示のように、ステップＳ１００へ戻る。
【０１６２】
ここまでで説明した、物体位置推定装置２００の動作フロー（図９、図１０、及び、図１１）の主要な処理ステップに関して、物品の存在状態変化に応じてどのようなタイミングで各処理が行われるかについて、タイミングチャート形式で簡単に触れておく。
【０１６３】
図１４の下半分のチャート１４Ｂは、図９、図１０、及び、図１１に示した物体位置推定装置２００の処理フローの主な処理ステップが動作するタイミングを示すチャートである。この物体位置推定装置２００の動作シーケンスのタイミングチャートであるチャート１４Ｂは、物品の状態変化の時間経過を表すチャート１４Ａと時間軸（横軸）を共有している。チャート１４Ｂにおいて、「▲」は短時間で行われる処理ステップが動作したタイミングを表し、実線矢印は、短時間処理のステップが繰り返し行われる期間、あるいは、一定時間継続する処理ステップが動作しているタイミングを表す。
【０１６４】
物品の状態変化が起こっていない期間（ｔ＜ｔ１，ｔ３＜ｔ＜ｔ５，ｔ７＜ｔ＜ｔ８，ｔ１０＜ｔ＜ｔ１１，ｔ１３＜ｔ＜ｔ１４，ｔ１６＜ｔ）は、ステップＳ１００〜ステップＳ３００の観測値取得と物品の状態変化の判定処理とが繰り返し行われる。
【０１６５】
物品状態変化（物品存在状態変化）が起こったタイミング（ｔ＝ｔ１，ｔ５，ｔ８，ｔ１１，ｔ１４）では、ステップＳ４００を経てステップＳ５００でバッチ推定部２０５による物品の位置推定処理が行われる。ステップＳ５００で複数の観測値を取得し（ステップＳ５０１）、バッチ推定処理（ステップＳ５０２）が完了した後、ステップＳ８００で、バッチ推定で得られた物品位置推定値を、物品位置推定値テーブル２０６に記録したのち、ステップＳ１００に戻り、ステップＳ１００〜ステップＳ３００の繰り返しが再開される。
【０１６６】
なお、図１８は時刻ｔ＝ｔ１６の時点での、物品状態変化情報テーブル２０４の内容を表し、図１９は、同じく時刻ｔ＝ｔ１６の時点での、物品位置推定値テーブル２０６の内容を表す。
【０１６７】
図１４のタイミングチャートにおいて、ｔ＝ｔ８においては、物品ＩＤ＝０００１、物品ＩＤ＝０００２の２つの物品が同時に取られるケースが生じている。この場合においても、図１０のフローチャートのステップＳ２０１からステップＳ２０９に至る処理フローを通じて、次のように２つの物品が取られたことが判定される。
【０１６８】
ｔ＝ｔ８において得られた１つの観測値（図１３の１３０４）と、その時点での最新の物品位置推定値（図１９のｔ＝ｔ５の物品位置推定値）に関して、ステップＳ２０１でアソシエーション尤度の計算が物品状態変化判定部２０３でなされ、ステップＳ２０２では、物品位置推定値の個数Ｎ＝３に対して、観測値の個数Ｍ＝１であるため、物品が取られたと物品状態変化判定部２０３で判定される。
【０１６９】
図２０に時刻ｔ８におけるアソシエーション尤度の計算結果を示す。このアソシエーション尤度に基づいて、ステップＳ２０７及びステップＳ２０４の処理において、物品ＩＤ＝０００１及び物品ＩＤ＝０００２の両方が、この１つ得られている観測値（図１３の１３０４）に対して、尤度が最大ではないので、この２つの物品が取られたと物品状態変化判定部２０３で判定される。
【０１７０】
図１４のタイミングチャートにおいて、ｔ１０＜ｔ＜ｔ１１の期間では、物品ＩＤ＝０００１、物品ＩＤ＝０００２、物品ＩＤ＝０００４の３つが取られている状態であり、ｔ＝ｔ１１で、その内の１つ置かれた（図１４では物品ＩＤ＝０００１が置かれた）という状況が発生している。ｔ＝ｔ１１において、物品ＩＤ＝０００１、物品ＩＤ＝０００２、物品ＩＤ＝０００４のうち、どの物品が置かれたかの物品状態変化判定部２０３での判定については、図１０のフローチャートのステップＳ２０１からステップＳ２０６に至る処理フローを通じて、物品状態変化判定部２０３で、次のように解決される。
【０１７１】
まず、ｔ＝ｔ１１において得られた２つの観測値（図１３の１３０５）と、その時点での最新の物品位置推定値（図１９のｔ＝ｔ８の物品位置推定値）に関して、ステップＳ２０１でアソシエーション尤度の計算が物品状態変化判定部２０３でなされ、ステップＳ２０２では、物品位置推定値の個数Ｎ＝１に対して、観測値の個数Ｍ＝２であるため、物品が置かれたと物品状態変化判定部２０３で判定される。
【０１７２】
ステップＳ２０３及びステップＳ２０４の処理では、物品ＩＤ＝０００２の位置推定値、あるいは、と物品ＩＤ＝０００３の位置推定値のどちらに関しても、アソシエーション尤度が最大にならない観測値（図１３の１３０５の上から１番目）が物品状態変化判定部２０３で特定される。
【０１７３】
ステップＳ２０５では、その特定された観測値の、観測ＩＤ尤度のうち、値が最大になる物品ＩＤは、０００１であるため、物品ＩＤは０００１と物品状態変化判定部２０３で特定され、物品ＩＤ＝０００４ではなく、物品ＩＤ＝０００１が置かれたことが物品状態変化判定部２０３で判定できる。
【０１７４】
ここで、図９のフローのステップＳ６００及びステップＳ７００の処理を具体例に基づいて補足説明する。
【０１７５】
図１４のタイミングチャートにおいて、ｔ＝ｔ１４において、物品ＩＤ＝０００４が置かれている。このとき（ｔ＝ｔ１４）の物品の観測値は、図１３の１３０６である。観測値１３０６の上から３つ目の観測値は、ｔ＝ｔ１４で置かれた物品ＩＤ＝０００４に対応するものだが、物品画像認識センサ２０９の物品の識別誤りにより、ＩＤ＝０００４ではなくＩＤ＝０００２の観測ＩＤ尤度が最大になっている。
【０１７６】
観測値１３０６と、その時点での最新の物品位置推定値（図１９のｔ＝ｔ１１の物品位置推定値）に関して、ステップＳ２０１でアソシエーション尤度の計算が物品状態変化判定部２０３でなされ、ステップＳ２０２では、物品位置推定値の個数Ｎ＝２に対して、観測値の個数Ｍ＝３であるため、物品が置かれたと物品状態変化判定部２０３で判定される。
【０１７７】
図２１にｔ＝ｔ１４におけるアソシエーション尤度の計算結果を示す。ステップＳ２０３、ステップＳ２０４の処理では、この図２１の尤度の計算結果に基づき、物品ＩＤ＝０００１の位置推定値、あるいは、物品ＩＤ＝０００３の位置推定値のどちらに関しても、アソシエーション尤度が最大にならない観測値（図１３の１３０６の上から３番目）が物品状態変化判定部２０３で特定される。ステップＳ２０５では、その特定された観測値の、観測ＩＤ尤度のうち、値が最大になる物品ＩＤは、上述の通り、ＩＤ＝０００２であるため、物品ＩＤは０００２と物品状態変化判定部２０３で特定され、図９のステップＳ２００では、物品ＩＤ＝０００２が置かれたと物品状態変化判定部２０３で判定される。
【０１７８】
そして、ステップＳ４００では、物品状態変化情報テーブル２０４に、物品ＩＤ＝０００２がＰＵＴされたと物品状態変化判定部２０３で記録される。
【０１７９】
次に、ステップＳ５００のバッチ推定処理では、複数回数に渡る観測値を入力として、物品位置の推定を行うので、一時的に物品の識別誤りを含んだ観測値１３０６以降に得られる識別誤りのない観測値と合わせて、バッチ推定部２０５が推定することにより、物品ＩＤ＝０００４を物品ＩＤ＝０００２に識別誤りした観測値１３０６の影響は抑えられ、推定結果として物品ＩＤ＝０００１、物品ＩＤ＝０００３、物品ＩＤ＝０００４が存在するという推定結果がバッチ推定部２０５により得られる。
【０１８０】
そこで、ステップＳ６００では、物品状態変化情報テーブル２０４に記録された物品状態変化情報をバッチ推定部２０５が参照し、物品ＩＤ＝０００２がＰＵＴされたという情報が、バッチ推定処理結果と矛盾するというバッチ推定部２０５での判定になる。そのため、ステップＳ７００において、物品状態変化情報テーブル２０４に記録された物品ＩＤ＝０００２がＰＵＴされたという情報をバッチ推定部２０５で削除し、物品状態変化情報テーブル２０４内において物品ＩＤ＝０００４がＰＵＴされたという情報にバッチ推定部２０５で書き換える。
【０１８１】
よって、物品画像認識センサ２０９の一時的な物品の識別情報の誤りにより、物品状態変化判定部２０３が、物品状態の変化の判定を誤っても、バッチ推定部２０５での複数観測値による物品位置推定処理により、物品状態変化情報テーブル２０４に記録される物品状態情報が正しく訂正される。
【０１８２】
最後に、物品位置表示ディスプレイ２１０の動作について、図１２のフローチャートで説明する。なお、図９に示される処理フローと、図１２の処理フローとは、互いに独立に（非同期）に動作するものとする。
【０１８３】
図１２のステップＳ９００では、物品位置表示操作用マウス２１１を使用することにより、ユーザが物品の位置を知りたい時刻の設定を物品位置表示ディスプレイ２１０で受け付ける。具体的には、物品位置表示ディスプレイ２１０の画面（図８）で、ユーザがマウスポインタ８０４を操作し、矩形領域８０３の「戻る」ボタン、あるいは、「進む」ボタンをクリックする、あるいは、クリックし続けることで、矩形領域８０３の右端の時刻ｔを変化させ、ユーザがクリック状態を解放したタイミングで表示されている時刻ｔを、ユーザが物品位置を知りたい時刻として物品位置表示ディスプレイ２１０で設定する。
【０１８４】
次いで、ステップＳ１０００では、ステップＳ９００で設定した時刻における物品位置の情報を物品位置表示ディスプレイ２１０から物品位置推定値出力部２０７に対して要求する。
【０１８５】
次いで、ステップＳ１１００では、物品位置推定値出力部２０７が、要求された時刻における物品位置推定値の情報を、物品位置推定値テーブル２０６から取得し、物品位置表示ディスプレイ２１０に出力する。
【０１８６】
次いで、ステップＳ１２００では、物品位置表示ディスプレイ２１０で受け取った物品の位置推定値、さらに、どの物品が持ち運び中であるかの情報を、物品位置表示ディスプレイ２１０の表示画面２１０ａの矩形領域８０１、及び、矩形領域８０２に表示する。
【０１８７】
図１４のチャート１４Ａに示すように物品の状態が変化した場合には、ユーザにより指定される時刻ｔの値により、図２２Ａ〜図２２Ｆに示すような形で物品の推定位置の表示が変化する。図２２Ａは時刻ｔ＜ｔ１（例えばｔ＝ｔ０）のときの物品の推定位置の表示を示す画面である。図２２Ｂは時刻ｔ１≦ｔ＜ｔ５のときの物品の推定位置の表示を示す画面である。図２２Ｃは時刻ｔ５≦ｔ＜ｔ８のときの物品の推定位置の表示を示す画面である。図２２Ｄは時刻ｔ８≦ｔ＜ｔ１１のときの物品の推定位置の表示を示す画面である。図２２Ｅは時刻ｔ１１≦ｔ＜ｔ１４のときの物品の推定位置の表示を示す画面である。図２２Ｆは時刻ｔ１４≦ｔのときの物品の推定位置の表示を示す画面である。
【０１８８】
前記第１実施形態にかかる構成によれば、物品状態変化判定部２０３により、複数の物品に対して得られる複数の観測値と、物品位置推定値テーブル２０６に記録される最新の複数の物品状態との対応関係の確からしさをアソシエーション尤度として計算することで、どの物品が置かれたか、又は、どの物品が取られたかを物品状態変化判定部２０３で判定することができる。これにより、物品の存在状態の変化の有無を検知することができ、物品の存在状態の変化があった場合のみ、バッチ推定部２０５で高精度に物品の位置を推定し、物品の存在状態の変化が無い間は、物品位置推定テーブル２０６に記録されているバッチ推定による高精度な物品位置推定結果を、物品位置推定結果として出力できる。
【０１８９】
すなわち、前記物体位置推定装置２００、及び、物体位置推定装置２００により実施される物体位置推定方法、及び、物体位置推定装置２００をプログラムとして構成する物体位置推定プログラムによれば、複数の準静止物品（例えば、静止と移動を繰り返すような物品）の観測において、移動から静止へと物品の状態が変化したタイミングで、バッチ推定により物品の位置を高精度で確定した後は、物品が静止している間は、バッチ推定によって得た高精度の位置情報を推定情報として出力することができるという格別の効果を有する。
【０１９０】
さらに、本発明の物体位置推定装置２００、及び、物体位置推定装置２００により実施される物体位置推定方法、及び、物体位置推定装置２００をプログラムとして構成する物体位置推定プログラムによれば、観測対象の物品の静止から移動、あるいは、移動から静止の状態変化を物品状態変化判定部２０３によって判断することにより、複数の物品すべてについて、観測中の任意の時刻における物品の静止、あるいは、移動の状態を把握することができるという効果も有する。
【０１９１】
なお、本発明は前記実施形態に限定されるものではなく、その他種々の態様で実施できる。
【０１９２】
例えば、本第１実施形態においては、物品位置の推定結果を物品位置表示ディスプレイ２１０に表示するとしたが、物品の推定位置の利用形態は、物品の位置を知ることを要求する他の装置への入力とすることももちろん可能であり、本発明の範囲を限定するものではない。
【０１９３】
また、例えば、物体としては、前記物品に限られるものではなく、人又はペットなどの動物でもよい。要するに、本発明で対象となる物体とは、人が搬送可能な物体を意味するものである。
【０１９４】
なお、前記実施形態において、物体状態変化判定手段１０１，２０３と、バッチ推定手段１０２，２０５と、物体状態情報記憶手段１０３，２０４，２０６となどのそれぞれ、又は、そのうちの任意の一部は、それ自体がソフトウェアで構成することができる。よって、例えば、本願明細書のそれぞれの実施形態の制御動作を構成するステップを有するコンピュータプログラムとして、記憶装置（ハードディスク等）などの記録媒体に読み取り可能に記憶させ、そのコンピュータプログラムをコンピュータの一時記憶装置（半導体メモリ等）に読み込んでＣＰＵを用いて実行することにより、前記した各機能又は各ステップを実行することができる。
【０１９５】
なお、前記様々な実施形態又は変形例のうちの任意の実施形態又は変形例を適宜組み合わせることにより、それぞれの有する効果を奏するようにすることができる。
【産業上の利用可能性】
【０１９６】
本発明に係る物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムは、観測対象の空間に存在し、任意のタイミングで持ち運ばれる可能性のある複数の物体（例えば複数の物品）の位置を推定する装置に利用可能である。例えば、家庭内の物品位置を管理するシステム、又は、ユーザから要求された物品を自律的に運搬する生活支援ロボットなどへの利用が可能である。【０１９７】
本発明は、添付図面を参照しながら好ましい実施形態に関連して充分に記載されているが、この技術の熟練した人々にとっては種々の変形又は修正は明白である。そのような変形又は修正は、添付した請求の範囲による本発明の範囲から外れない限りにおいて、その中に含まれると理解されるべきである。
【図１】
2011108055.tif 000013
【図２Ａ】
2011108055.tif 000014
【図２Ｂ】
2011108055.tif 000015
【図３】
2011108055.tif 000016
【図４】
2011108055.tif 000017
【図５】
2011108055.tif 000018
【図６】
2011108055.tif 000019
【図７】
2011108055.tif 000020
【図８】
2011108055.tif 000021
【図９】
2011108055.tif 000022
【図１０】
2011108055.tif 000023
【図１１】
2011108055.tif 000024
【図１２】
2011108055.tif 000025
【図１３】
2011108055.tif 000026
【図１４】
2011108055.tif 000027
【図１５】
2011108055.tif 000028
【図１６】
2011108055.tif 000029
【図１７】
2011108055.tif 000030
【図１８】
2011108055.tif 000031
【図１９】
2011108055.tif 000032
【図２０】
2011108055.tif 000033
【図２１】
2011108055.tif 000034
【図２２Ａ】
2011108055.tif 000035
【図２２Ｂ】
2011108055.tif 000036
【図２２Ｃ】
2011108055.tif 000037
【図２２Ｄ】
2011108055.tif 000038
【図２２Ｅ】
2011108055.tif 000039
【図２２Ｆ】
2011108055.tif 000040
【手続補正書】
【提出日】平成23年9月14日(2011.9.14)
【手続補正１】
【補正対象書類名】明細書
【補正対象項目名】全文
【補正方法】変更
【補正の内容】
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、センサなどの観測装置からの対象物体に関する観測値に基づいて、観測対象の空間内に存在する複数物体の位置を推定する物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムに関するものである。
【背景技術】
【０００２】
センサの観測値に基づいて物体の状態（例えば位置）を推定するための方式として、大きく分けて、逐次（オンライン）推定方式とバッチ（オフライン）推定方式とが存在する。
【０００３】
逐次推定方式は、時系列的に得られる観測値を逐次的に処理する方式であり、観測値が得られる度に、即時、物体の状態推定値が得られ演算コストも少ないという特長がある。しかし、その反面、都度得られた観測値を頼りに推定を行うために、センサの観測誤差、あるいは、観測エラーの影響を受けやすく、外れ値が観測値として得られた場合には推定値の精度が著しく低下するという問題がある。
【０００４】
一方、バッチ推定方式は、蓄積されたセンサ観測値を一括処理する方式であり、時系列的に得られた一連の複数の観測値を一括処理するため、一定期間の観測値が得られた後に始めて推定が可能になるという特徴がある。また、演算コストが大きいという問題はあるものの、観測誤差、あるいは、観測エラー等によって発生しうる外れ値による推定精度の低下に対して頑健であるという特長もある。
【０００５】
センサの観測値に基づいて物体の状態を推定する従来技術として、逐次推定方式とバッチ推定方式の双方の特長を組み合わせる方式（特許文献１）がある。
【０００６】
特許文献１では、逐次推定方式とバッチ推定方式の併用によって、人工衛星の位置の観測データから人工衛星の軌道を特定する装置・方法が開示されている。
【０００７】
具体的には、１）バッチ推定により人工衛星の軌道を拘束する運動方程式のパラメータを推定する、２）その推定された運動方程式のパラメータを逐次推定のための初期値とする、３）逐次推定により人工衛星の位置を逐次推定する、という３つの処理ステップを基本サイクルとする。バッチ推定により推定された運動方程式のパラメータから人工衛星の推定位置に関する予測誤差が導かれるが、この予測誤差はバッチ推定が完了してからの時間経過に伴って増大する。あらかじめ定めた閾値を超えたタイミングで、前記基本サイクルを繰り返すことにより、バッチ推定の高精度推定という特長と、逐次推定の即時性という特長を組み合わせた方式である。
【先行技術文献】
【特許文献】
【０００８】
【特許文献１】特開２００１−１５３６８２号公報
【発明の概要】
【発明が解決しようとする課題】
【０００９】
しかしながら、特許文献１で開示されている方式では、ある１つの運動方程式で記述される時間経過に伴い位置が連続的に移動する物体の位置推定を前提としている。このため、静止と移動をランダムに繰り返すような準静止物体の位置推定に用いた場合、静止していることが分かっている状態においても逐次推定を行い続けることになる。準静止物体の位置推定に用いる場合として、運動方程式で記述できない状態であって例えば人が持ち運びするような物体の位置推定に用いた場合などが考えられる。このため、バッチ推定によって高精度に位置情報が得られたとしても、センサの観測誤差、観測エラーの影響を受けやすい逐次推定により位置推定結果の精度が下がってしまうという課題を有するものであった。
【００１０】
また、特許文献１で開示されている方式では、観測対象が単体である物体、あるいは、観測対象物体が複数であっても観測した物体と観測値との対応関係が一意に定まる状況を前提としている。このため、観測値と観測された物体との対応関係が不定となる複数物体の位置推定には適用できないという課題を有するものであった。
【００１１】
従って、本発明の目的は、前記問題を解決することにあって、静止と移動とをランダムに繰り返すような準静止物体の位置推定においても、推定位置の精度を高く維持することができ、かつ、観測値と観測された物体との対応関係が不定となる複数物体の位置推定にも適用できる、物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムを提供することにある。
【課題を解決するための手段】
【００１２】
前記課題を解決するために、本発明は以下のように構成される。
【００１３】
本発明の第１態様によれば、観測対象の観測空間に存在する１つの物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、前記物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記物体の前記観測空間内での存在状態及び前記物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段が、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段とを備える物体位置推定装置を提供する。
【００１４】
本発明の第２態様によれば、観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段により、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と、
を備える物体位置推定装置を提供する。
【００１５】
本発明の第５態様によれば、観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、物体状態変化判定手段により、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定ステップと、
前記物体状態変化判定ステップで前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、バッチ推定手段により、前記物体の識別情報及び位置情報の推定を行うバッチ推定ステップと、
を備える物体位置推定方法を提供する。
【００１６】
本発明の第６態様によれば、コンピュータに、
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定機能と、
前記物体状態変化判定機能で前記物体の存在状態に変化があったと判定されたとき、物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定機能と、
を実現させるための物体位置推定プログラムを提供する。
【発明の効果】
【００１７】
本発明の物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムによれば、複数の準静止物体（例えば、静止と移動を繰り返すような物体）の観測において、移動から静止へと物体の状態が変化があったと物体状態変化判定手段で判定したときから取得された観測値と物体状態変化判定手段が決定した物体の存在状態とに基づき、バッチ推定により物体の位置を高精度で確定した後は、物体が静止している間は、バッチ推定によって得た高精度の位置情報を推定情報として出力できるという格別の効果を有する。すなわち、従来技術において、静止していると分かっている物体についても逐次推定により位置推定を行うために発生する位置誤差の問題は、本発明では発生しない。
【００１８】
さらに、本発明の物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムによれば、観測対象の物体の静止から移動、あるいは、移動から静止の状態変化を物体状態変化判定手段によって判断することにより、複数の物体すべてについて、観測中の任意の時刻における物体の静止、あるいは、移動の状態を把握することができるという効果も有す。
【図面の簡単な説明】
【００１９】
本発明のこれらと他の目的と特徴は、添付された図面についての好ましい実施形態に関連した次の記述から明らかになる。この図面においては、
【図１】図１は、本発明の第１様態の構成を示すブロック図であり、
【図２Ａ】図２Ａは、本発明の第１実施形態に係る、物体位置推定装置の構成例を示すブロック図であり、
【図２Ｂ】図２Ｂは、前記第１実施形態に係る前記物体位置推定装置の観測装置の一例である物体画像認識センサの構成を示すブロック図であり、
【図３】図３は、本発明の前記第１実施形態に係る前記物体位置推定装置を部屋に設置した例を示す図であり、
【図４】図４は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定において、観測対象の物体の一例としての物品の例を示す図であり、
【図５】図５は、本発明の前記第１実施形態に係る前記物体位置推定装置の観測値蓄積テーブルに記録された情報の一例を示す図であり、
【図６】図６は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品状態変化情報テーブルに記録された情報の一例を示す図であり、
【図７】図７は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品位置推定値テーブルに記録された情報の一例を示す図であり、
【図８】図８は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品位置表示ディスプレイの画面の表示例を示す図であり、
【図９】図９は、本発明の前記第１実施形態に係る前記物体位置推定装置の動作のフローチャートであり、
【図１０】図１０は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化の判定処理（ステップＳ２００）のフローチャートであり、
【図１１】図１１は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理のバッチ推定処理（ステップＳ５００）のフローチャートであり、
【図１２】図１２は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品位置表示ディスプレイの動作のフローチャートであり、
【図１３】図１３は、本発明の前記第１実施形態に係る前記物体位置推定装置の観測値蓄積テーブルに記録された情報の一部を示す図であり、
【図１４】図１４は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の時間変化と物体位置推定装置の動作シーケンスの変化を表したタイミングチャートであり、
【図１５】図１５は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化を判断するための尤度の計算例を示す図であり、
【図１６】図１６は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化を判断するための尤度の計算例を示す図であり、
【図１７】図１７は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化を判断するための尤度の計算例を示す図であり、
【図１８】図１８は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品状態変化情報テーブルに記録された情報の一例を示す図であり、
【図１９】図１９は、本発明の前記第１実施形態に係る前記物体位置推定装置の物品位置推定値テーブルに記録された情報の一例を示す図であり、
【図２０】図２０は、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態変化を判断するための尤度の計算例を示す図であり、
【図２１】図２１は、本発明の前記第１実施形態に係る、物品存在状態変化を判定するための尤度の計算例を示す図であり、
【図２２Ａ】図２２Ａは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｂ】図２２Ｂは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｃ】図２２Ｃは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｄ】図２２Ｄは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｅ】図２２Ｅは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図であり、
【図２２Ｆ】図２２Ｆは、本発明の前記第１実施形態に係る前記物体位置推定装置における物体位置推定処理の物品存在状態の変化が物品位置表示ディスプレイに表示される例を示す図。
【発明を実施するための形態】
【００２０】
以下に、本発明にかかる実施の形態を図面に基づいて詳細に説明する。
【００２１】
以下、図面を参照して本発明における実施形態を詳細に説明する前に、本発明の種々の態様について説明する。
【００２２】
本発明の第１態様によれば、観測対象の観測空間に存在する１つの物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、前記物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記物体の前記観測空間内での存在状態及び前記物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段が、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と
を備える物体位置推定装置を提供する。
【００２３】
本発明の第２態様によれば、観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段により、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と、
を備える物体位置推定装置を提供する。
【００２４】
本発明の第３態様によれば、前記物体状態変化判定手段により、前記観測対象の前記物体が前記静止状態から移動状態に変化したと判定され、その後、前記移動状態から静止状態に変化したと判定されるまでの間は、前記バッチ推定手段が、前記当該物体の識別情報及び位置情報の推定を行わないとともに、推定値の出力も行わない、
第１又は２の態様に記載の物体位置推定装置を提供する。
【００２５】
本発明の第４態様によれば、前記物体状態変化判定手段により、前記観測対象の前記物体が移動状態から静止状態に変化したと判定され、その後、前記静止状態から移動状態に変化したと判定されるまでの間は、前記バッチ推定手段が、前記当該物体が前記静止状態に変化したと判定されたときに、前記当該物体の識別情報及び位置情報の推定を１度だけ行ったのち、その推定により得られた推定値を当該物体の物体状態情報として出力する、
第１又は２の態様に記載の物体位置推定装置を提供する。
【００２６】
本発明の第５態様によれば、観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、物体状態変化判定手段により、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定ステップと、
前記物体状態変化判定ステップで前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、バッチ推定手段により、前記物体の識別情報及び位置情報の推定を行うバッチ推定ステップと、
を備える物体位置推定方法を提供する。
【００２７】
本発明の第６態様によれば、コンピュータに、
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定機能と、
前記物体状態変化判定機能で前記物体の存在状態に変化があったと判定されたとき、物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定機能と、
を実現させるための物体位置推定プログラムを提供する。
【００２８】
図１は本発明の前記第１様態にかかる物体位置推定装置の構成の一例を示すブロック図である。この第１様態にかかる物体位置推定装置は、物体観測値(物体の位置情報と識別情報)が入力される物体状態変化判定手段(物体状態変化判定部)１０１と、物体観測値(物体の位置情報と識別情報)と物体状態変化判定手段１０１からの出力情報が入力されるバッチ推定手段(バッチ推定部)１０２とを備えるように構成している。なお、この構成において、バッチ推定手段１０２からの出力情報が入力されるとともに物体状態変化判定手段１０１へ出力する物体状態情報記憶手段(物体状態情報記憶部)１０３をさらに備えるようにしてもよい。
【００２９】
本構成によって、物体状態変化判定手段１０１において、観測対象の観測空間に存在する物体の識別情報及び前記物体の位置情報を含む観測値の一例として観測空間内において複数の物体に対して得られる各々の観測値と、物体位置推定装置内で推定される物体各々の物体状態、例えば、最新の物体各々の物体状態との対応関係を計算する。計算の結果、対応する物体の存在状態に変化が有ったと判定された観測値、例えば、対応する物体状態が存在しないと判断された観測値がある場合は、観測空間内に新たに物体が出現した（あるいは観測可能状態になった）ことが判明する。反対に、対応する観測値が存在しないと判断された物体状態がある場合は、観測空間内において物体が消滅した（あるいは観測不可能状態になった）ことが判明する。
【００３０】
そして、観測空間内の物体の存在状態の変化が物体状態変化判定手段１０１で判定したときから取得された観測値（例えば、前記観測空間内の物体の存在状態の変化が物体状態変化判定手段１０１で判定されたタイミングから一定期間（一定回数）得られる複数の観測値）と、前記物体状態変化判定手段が決定した物体の存在状態とに基づきバッチ推定をバッチ推定手段１０２で行うことで、複数の観測値と物体との対応関係を考慮しつつ、各々の物体に関する位置推定を高精度で行うことができる。
【００３１】
さらに、物体状態変化判定手段１０１において、物体の存在状態の変化が無いと判定されている間は、このバッチ推定により高精度に推定された推定位置を物体状態情報記憶手段１０３に保持し最新の物体位置情報として維持し続けることもできるので、逐次推定で問題となる静止と移動をランダムに繰り返すような準静止物体などの位置推定における、観測装置の観測誤差、あるいは、観測エラーの影響による推定位置精度の低下を回避することができる。
【００３２】
以下に、本発明にかかる実施形態を図面に基づいて詳細に説明する。
【００３３】
（第１実施形態）
本発明の第１実施形態における物体位置推定装置２００は、観測空間の一例である生活空間などの室内を天井から、観測装置の一例である物品画像認識センサ２０９で撮影し、画像認識処理により物体の一例としての物品の位置検出処理及び物品の識別処理を行い、位置情報と識別情報とを含む観測情報に基づいて、物品の存在状態の変化を判定し、物品位置を推定するというものである。本実施形態では、物品画像認識センサ２０９の一例としてカメラを用いている。図２Ｂに示すように、物品画像認識センサ２０９は、撮像部２０９ａと、撮像部２０９ａで撮像された画像を画像認識処理する画像認識処理部２０９ｂと、撮像部２０９ａで撮像された画像及び画像認識処理部２０９ｂで処理された結果の情報などを記憶する記憶部２０９ｃとを備えている。
【００３４】
図２Ａは、本発明の第１実施形態における物体位置推定装置２００の構成を示すブロック図である。物体位置推定装置２００は、観測値取得部２０１と、観測値蓄積テーブル（観測値記憶部）２０２と、図１の物体状態変化判定手段１０１の一例として機能する物品状態変化判定部（物品状態変化判定手段）２０３と、図１の物体状態情報記憶手段１０３の一例として機能する物品状態変化情報テーブル（物品状態変化情報記憶部）２０４と、図１のバッチ推定手段１０２の一例として機能するバッチ推定部（バッチ推定手段）２０５と、図１の物体状態情報記憶手段１０３の一例として機能する物品位置推定値テーブル（物品位置推定値記憶部）２０６と、物品位置推定値出力部２０７と、時刻管理部２０８と、物品画像認識センサ２０９と、物品位置表示ディスプレイ（物品位置表示部）２１０と、物品位置表示操作用マウス（物品位置表示操作部）２１１とを備えるように構成される。
【００３５】
図３は、本発明の前記第１実施形態の物体位置推定装置２００の物品画像認識センサ２０９を、観測空間の一例である部屋３００に設置した例を示す。図３に示すように、物品画像認識センサ２０９は部屋３００の天井３０１に設置されている。なお、この部屋３００における位置を記述する座標系は、図３に示すように、部屋３００の床面３０２の北西角を原点とし、床面３０２の南方向にＸ軸、床面３０２の南方向にＹ軸、床面３０２の鉛直方向にＺ軸をそれぞれ取る直交座標系とする。以後の説明では、この座標系を部屋３００の世界座標系、又は、単に世界座標系と記述する。
【００３６】
物品画像認識センサ２０９は、図２Ｂに示すように、部屋３００の画像を撮影し撮影時刻毎に輝度値の２次元配列である撮像データを出力するカメラ部（撮像部）２０９ａと、カメラ部２０９ａにより出力された撮像データに対して画像認識処理を行う画像認識部２０９ｂとカメラ部２０９ａで撮像された画像及び画像認識処理部２０９ｂで処理された結果の情報などを記憶する内部記憶部２０９ｃとを備えるように構成されている。カメラ部２０９ａは、部屋３００の全体を撮影できる画角を有するものとする。
【００３７】
ここでは、物品画像認識センサ２０９が有するカメラ部２０９ａを構成するカメラの台数は１台とするが、複数のカメラを有していてもよい。たとえば、画角の小さいカメラを複数台用いて部屋３００の全体を撮影できるような構成でもよい。さらに、各カメラの撮影範囲が重複しており、同一の領域を複数方向から撮影できるような構成であってもよい。
【００３８】
画像認識部２０９ｂは、カメラ部２０９ａが出力する撮像データに対して、背景差分法により物品領域画像を抽出し、まず物品の位置を特定する。例えば、図２Ｂに示すように、カメラ部２０９ａで予め撮像して内部記憶部２０９ｂに記憶して用意しておいた、物品が存在していないときの部屋３００の背景画像データと、カメラ部２０９ａで撮像した現在の画像データとを、画像処理部２０９ｃで比較する。その後、画素値が異なる領域を差分領域として画像処理部２０９ｃで取り出す。この差分領域が、検出した物品に相当する。さらに、抽出した各物品領域画像に対して、識別すべき物品毎に予め用意されたテンプレート画像と照合を画像処理部２０９ｃで行うことにより、物品の種類を画像処理部２０９ｃで識別する。照合用のテンプレート画像は、内部記憶部２０９ｃに予め記録されているものとする。なお、物品の識別ないし位置特定のための画像認識処理については、他の方法でもよい。例えばＳＩＦＴ特徴量による物品識別アルゴリズムを用いることもできる。
【００３９】
物品画像認識センサ２０９が出力する観測値は、認識された物品の観測位置と、物品の種類ごとにあらかじめ割り振られた物品ＩＤに関して、観測した物品がどの物品であるかの確からしさである観測ＩＤ尤度とを組み合わせたデータである。
【００４０】
上述の物品ＩＤの一例を示す。例えば、図４に示すように、観測対象の物品が、コップ、リモートコントロール装置（リモコン）、ティッシュ箱、雑誌の４つであった場合、コップに対しては物品ＩＤ０００１を、リモコンに対しては物品ＩＤ０００２を、ティッシュ箱に対しては物品ＩＤ０００３を、雑誌に対しては物品ＩＤ０００４を割り当てるとする。どの物品に対して、具体的にどのＩＤ（図４の例では０００１〜０００４までの識別子）を割り当てるかについては、任意でよい。
【００４１】
図５は、後ほど説明する観測値蓄積テーブル２０２に記録される内容を例示したものであるが、図５で、物品画像認識センサ２０９の出力する観測値の例を示す。観測値の例として、ここでは、観測時刻（観測値を取得した時刻）ｔと観測ＩＤ尤度と観測位置（ＸＹＺ座標の値）とが記憶されている。図５の領域５０１（背景を灰色とした部分）のデータが、１つの物品に関する観測値（観測時間ｔ＝２７秒のときの観測ＩＤ尤度と観測位置とで構成される観測値）である。左から２番目から５番目までの４つのマス（物品ＩＤが０００１、物品ＩＤが０００２、物品ＩＤが０００３、物品ＩＤが０００４）の数値が観測ＩＤ尤度、右から３つ目のマス（観測位置のＸ座標の値、Ｙ座標の値、Ｚ座標の値）の数値が世界座標系での観測位置である。この観測値における観測位置は、物品画像認識センサ２０９の撮像した画像データの画像座標系における位置を世界座標系に変換した位置である。
【００４２】
なお、本第１実施形態では、部屋３００内の物品を観測する物品画像認識センサ２０９として、画像認識機能を備えた画像センサとしたが、観測対象の物品の位置、及び、種類の判別が可能であれば、画像センサ以外のセンサでもよい。例えば、物品画像認識センサ２０９の別の例として、ＲＦＩＤ、又は、レーザ距離センサ等、又は、複数の異種のセンサの組み合わせを用いてもよい。
【００４３】
図２Ａにおける観測値取得部２０１は、物品画像認識センサ２０９からの観測値を一定時間ごとに逐次取得し、時刻管理部２０８が保持する現在時刻を参照し、観測値を取得した時刻と観測値とを、観測値蓄積テーブル２０２に追加記録する。なお、本第１実施形態においては、観測値取得部２０１は、例えば１秒ごとのように、所定の周期で、観測値を取得するものとする。
【００４４】
観測値取得部２０１で、一度に取得される観測値は、観測できた物品の個数分の複数の観測値である。図５において、領域５０２で灰色背景の領域の観測値は、時刻ｔ＝２８秒に取得された複数の観測値（図５では４個の観測値）である。各観測値は、観測された結果としての観測ＩＤ尤度と観測位置との組で構成されている。
【００４５】
観測値取得部２０１は、観測値を観測値蓄積テーブル２０２に記録すると同時に、物品状態変化判定部２０３に出力する。
【００４６】
観測値蓄積テーブル２０２は、観測値取得部２０１で取得された観測値を観測時刻と共に蓄積する。図５に、蓄積された観測値のうち時刻ｔ＝２７〜３６秒に取得された観測値を示す。
【００４７】
図５は、真の位置の世界座標が、それぞれ（１２５，６５４，０），（２９６，３６２，６０），（３８，４９６，０），（３２１，７１５，７０）である４個の物品ＩＤ＝０００１〜０００４を観測した結果、得られた観測値を表す。時刻の単位は秒、位置の単位はセンチメートルである。図５において、時刻ｔ＝２９秒及び時刻ｔ＝３４秒においては、観測値が物品数分（ここでは４個分）得られていないが、物品画像認識センサ２０９において物品画像抽出に失敗したなど、観測値が欠損する場合があることを示している。
【００４８】
さて、物品画像認識センサ２０９は、画像認識により物品の識別を行うので、物品の識別誤りの可能性がある。この誤りの可能性を、「観測ＩＤ尤度」という数値で定量的に表現する。「観測ＩＤ尤度」の意味は、物品画像認識センサ２０９による物品の識別結果に関する物品ＩＤごとの確からしさの分布である。言い換えると、「観測ＩＤ尤度」は、観測値がどの物品を観測したかの確率分布を意味する。
【００４９】
図５の領域５０２の４つの観測値は、上から順に、物品ＩＤ＝０００１，物品ＩＤ＝０００２、物品ＩＤ＝０００３、物品ＩＤ＝０００４を観測した結果得られた観測値である。
【００５０】
領域５０２の上から１番目の観測値は、物品ＩＤ＝０００１の観測ＩＤ尤度の値が０．４で最も高く、他の物品ＩＤの観測ＩＤ尤度は、０．２である。観測値は、物品ＩＤ＝０００１を観測した観測値である確率が０．４であり、他の物品ＩＤ＝０００１以外の物品を観測した確率は、０．２であることを示す。
【００５１】
領域５０２の上から３番目の観測値は、物品ＩＤ＝０００３の観測ＩＤ尤度の値が０．７で最も高く、他の物品ＩＤの観測ＩＤ尤度は、０．１である。この観測値は、物品ＩＤ＝０００３を観測した観測値である確率が０．７であり、物品ＩＤ＝０００３以外の物品を観測した確率は、０．１であることを示す。
【００５２】
領域５０２の１番目の観測値が物品ＩＤ＝０００１を観測した確率（０．４）よりも、３番目の観測値が物品ＩＤ＝０００３を観測した確率（０．７）の方が高く、物品の識別の信頼性という意味からすると、１番目の観測値よりも３番目の観測値の方が信頼性が高いということになる。
【００５３】
識別する物品それぞれの画像的特徴、又は、物品間の画像的特徴の差、又は、物品を観測する空間の照明条件、又は、オクルージョンの状況（手前側に位置する物体で奥側に位置する物体が認識しにくくなっている状況）などによって、物品の認識間違いの状況は変わってしまう。そのため、理想的には、観測を行う度に、その観測条件を考慮して識別間違いの可能性を反映した観測ＩＤ尤度を算出すべきであるが、そのためには、事前にあらゆる観測条件を評価することが必要で、事実上、そのようなことは実行不可能である。
【００５４】
実用上は、ある一定の（あるいは、限定した複数の）観測条件の下で、物品の識別実験を行い、物品識別の正解率から物品ごとに観測ＩＤ尤度を求めておいて、実際に物品の位置推定を行う際に、求めておいた観測ＩＤ尤度を割り当てることで近似する。本第１実施形態においても、物品画像認識センサ２０９が出力する観測ＩＤ尤度は、実験により予め求められているものとする。
【００５５】
さて、次に、領域５０３に示す２つの観測値に注目すると、観測ＩＤ尤度の分布から、領域５０３の１番目の観測値は物品ＩＤ＝０００１を観測した可能性が最も高く、領域５０３の２番目の観測値は物品ＩＤ＝０００２を観測した可能性が最も高い、という結果である。
【００５６】
しかし、物品の真の位置に対する観測位置の誤差範囲を考慮すれば、実際は１番目の観測値は物品ＩＤ＝０００２を観測し、２番目の観測値は物品ＩＤ＝０００１を観測したことが分かる。
【００５７】
つまり、図５の領域５０３では、物品ＩＤ＝０００１と物品ＩＤ＝０００２とを取り違えて識別したケースを示している。ここで注意すべきことは、物品の識別間違いを含む観測値を特定する形で説明しているが、これは、物品の真の位置が分かっているとした場合のことであり、実際には、観測値だけからは物品の識別間違いが起こっているかどうかは分からないということである。
【００５８】
物品状態変化判定部２０３は、観測対象の室内（観測空間の一例）に存在する物体の識別情報及び物体の位置情報を含む観測値が逐次得られる度に、各物体の識別情報及び位置情報を含む観測値と、観測対象の各物体の室内での存在状態及び各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、室内での物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する。具体的には、物品状態変化判定部２０３は、観測値取得手段２０１が取得した観測値と、物品位置推定値テーブル２０６に保持された過去の物品位置の推定値から、「物品が取られた」、又は、「物品が置かれた」という物品の存在状態変化が起こったかどうかを、観測値を受け取る度に逐次判定する。
【００５９】
物品状態変化判定部２０３の動作については、後ほどフローチャートを用いて詳細に説明する。
【００６０】
物品状態変化判定部２０３で「物品の存在状態変化有」と判定された場合、判定に用いた観測値の観測時刻及び物品の存在状態判定結果を物品状態変化判定部２０３が物品状態変化情報テーブル２０４に追加記録する。
【００６１】
物品状態変化情報テーブル２０４は、物品状態変化判定部２０３で判定された物品状態変化情報（物品が置かれた、又は、物品が取られたなどの物品の存在状態の変化に関する情報）を、観測時刻と共に記録する。記録された情報の例を図６に示す。
【００６２】
図６においては、物品ＩＤごとに、物品が取られたことを「ＴＡＫＥ」 で表現し、物品が置かれたことを「ＰＵＴ」で表現している。空欄については、当該の物品に関しては存在状態変化が無いことを示している。
【００６３】
バッチ推定部２０５は、物体状態変化判定部２０３により、物体の存在状態に変化があったと判定されたとき、物体状態変化判定部２０３が物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、物体状態変化判定部２０３が決定した物体の存在状態とに基づき、物体の識別情報及び位置情報の推定を行う。具体的には、バッチ推定部２０５は、物品状態変化判定部２０３からの判定結果情報に基づき、物品状態変化判定部２０３が、「物品の存在状態変化有」と判定した時刻から、一定時間経過するまでに得られた観測値を、観測値蓄積テーブル２０２から受け取り、その複数時刻に渡る観測値群を入力として、バッチ推定処理を実行する。
【００６４】
バッチ推定部２０５の動作については後で説明する。
【００６５】
物品状態変化判定部２０３で判定された物品の存在状態変化の結果と、バッチ推定部２０５で推定された物品位置の結果における物品の存在状態とに矛盾があったということを、バッチ推定部２０５で判定した場合は、バッチ推定部２０５の物品位置推定結果に基づき、物品状態変化情報テーブル２０４の物品状態変化情報をバッチ推定部２０５が書き換える。バッチ推定部２０５で推定された、物品毎の世界座標系における推定位置は、時刻情報と共に物品位置推定値テーブル２０６に追加記録される。このとき、記録する時刻情報は、バッチ推定に用いた観測値群の中で最初の観測値の観測時刻を用いる。
【００６６】
物品位置推定値テーブル２０６は、バッチ推定部２０５で推定された物品毎の推定位置の情報を記録する。記録された情報の例を図７に示す。図７の表中における、数値が入っていない（ハイフンで表現した）部分は、物品が人などにより持ち運ばれており、物品の位置が推定できなかったことを示している。
【００６７】
物品位置推定値出力部２０７は、物品位置表示操作用マウス２１１から物品位置表示ディスプレイ２１０を介して、ある時刻における特定の物品の位置の情報を出力するよう要求を受けた場合に、物品位置推定値テーブル２０６に記録されている物品毎の位置情報の中で、当該時刻に最も近い過去の位置推定値を出力する。ただし、指定された物品の位置情報が無い場合、つまり、指定された物品が人などにより持ち運びされている状態の場合は、指定された物品の位置情報を出力する代わりに、「持ち運び中」であるという情報を物品位置推定値出力部２０７から出力する。
【００６８】
図７に示す例のように物品の推定位置が記録されていると仮定して、物品位置表示ディスプレイ２１０から物品位置推定値出力部２０７が時刻３００（ｓｅｃ）における物品ＩＤ＝０００１の位置の出力を要請された場合は、時刻３００（ｓｅｃ）に最も近い過去の時刻２５１（ｓｅｃ）での推定位置である（１２５．１，６５３．８，０．１）を物品位置推定値出力部２０７から物品位置表示ディスプレイ２１０に出力する。物品位置表示ディスプレイ２１０から物品位置推定値出力部２０７が時刻３００（ｓｅｃ）における物品ＩＤ＝０００２の位置の出力を要請された場合、時刻３００（ｓｅｃ）に最も近い過去の時刻２５１（ｓｅｃ）において、物品ＩＤ＝０００２が人などにより持ち運ばれており物品ＩＤ＝０００２に関してその位置が推定できていないので、「人により持ち運び中」であることを物品位置推定値出力部２０７から物品位置表示ディスプレイ２１０に出力する。  物品位置表示ディスプレイ２１０は、物品位置表示操作用マウス２１１などを使用してユーザから指定された各物品の位置情報を物品位置推定値出力部２０７に要求し、受け取った各物品の推定位置を画面上に表示する。
【００６９】
図８に物品位置表示ディスプレイ２１０の表示画面２１０ａの表示例を示す。矩形領域８０１は、部屋３００を天井３０１から床面３０２を見下ろしたときの平面座標系、すなわち、部屋３００の世界座標のＸＹ平面に対応する。矩形領域８０１の左上角が原点（Ｘ，Ｙ）＝（０，０）である。各物品の位置は、黒丸印「●」と物品のＩＤと、物品が置かれた時刻ｔと、物品位置のＸＹＺ座標とで示される。ここでは、一例として、時刻３００（ｓｅｃ）における物品位置が、図７の時刻２５１（ｓｅｃ）における各物品の推定位置に基づいて表示されている。
【００７０】
矩形領域８０２は、人などによって運搬されている物品（位置推定ができなかった物品、言い換えれば、位置情報が無い物品）のＩＤを表示する。図８の例では、物品ＩＤ＝０００２が、人などによって運搬されており、位置情報が無いことを示す。
【００７１】
矩形領域８０３では、ユーザが物品位置を知りたい時刻を設定する。ユーザは、物品位置表示操作用マウス２１１を操作し、表示画面２１０ａ内のマウスポインタ８０４を動かして、矩形領域８０３の「戻る」ボタン、あるいは、「進む」ボタンをクリックすることによって、矩形領域８０３の右端に表示される時刻ｔの値を増減させることで、物品位置を知りたい時刻を指定する。
【００７２】
物品位置表示ディスプレイ２１０は、ユーザが、物品位置表示操作用マウス２１１を操作して物品位置を知りたい時刻を設定する度に、物品位置推定値出力部２０７に、当該時刻における物品の位置情報を要求し、物品位置推定値出力部２０７から物品位置推定値を受け取り、矩形領域８０１と矩形領域８０２にそれぞれ、各物品の位置と、人などによって運搬されている物品のＩＤとを表示する。
【００７３】
以後、物体位置推定装置２００の動作を、図９、図１０、及び、図１１のフローチャートを用いて詳細に説明する。
【００７４】
これ以降の物体位置推定装置２００の動作の説明では、物品の存在状態変化が図１４に示すタイミングチャートの上半分のチャート１４Ａのように起こったとものとして説明を進める。この物品の存在状態変化のタイミングチャートであるチャート１４Ａの縦軸は位置を表し、横軸は時間を表す。位置に関しては、説明の簡略化のために１次元で表している。物品ＩＤ＝０００１から物品ＩＤ＝０００４までの４個の物品の真の位置を実線の矢印で表し、物品が例えば人により持ち運ばれている状態を破線の矢印で表している。
【００７５】
物品は、人によって持ち運ばれるとき以外は静止しているので、チャート１４Ａでは、物品位置は位置軸に直交した直線で表現される。一方、物品が人によって持ち運ばれている間は任意の動きになるが、持ち運ばれている間の物品の位置は推定の対象外としているので、チャート１４Ａでは便宜上（破線）直線で表現している。
【００７６】
チャート１４Ａにおいて、物品存在状態変化があった（物品が「取られた」又は「置かれた」）時刻及び位置は、白丸の「○」印で表示し、物品が置かれた場合は白丸の「○」印中に「Ｐ」を表示し、物品が持ち去られた場合は白丸の「○」印中に「Ｔ」を表示している。
【００７７】
チャート１４Ａは、時刻ｔ１に物品ＩＤ＝０００４が置かれ、時刻ｔ５に物品ＩＤ＝０００４が取られ、時刻ｔ８に物品ＩＤ＝０００１と物品ＩＤ＝０００２とが取られ、時刻ｔ１１に物品ＩＤ＝０００１が置かれ、時刻ｔ１４に物品ＩＤ＝０００４が置かれるという物品の存在状態変化を表現している。時刻ｔ１からｔ１６までの間、物品ＩＤ＝０００３は何も存在状態が変化していないことを示している。
【００７８】
図１４に示す物品の存在状態変化に応じて、時刻ｔ１，ｔ４，ｔ５，ｔ８，ｔ１１，ｔ１４における物品の観測値は、図１３のとおり得られたものとする。
【００７９】
図９は、物体位置推定装置２００の動作フローを表すフローチャートである。ここでの動作の大まかな流れは、物品の観測値を得て、その観測値と物品の最新の推定位置とから、物品の存在状態変化があったかどうかを判定し、存在状態変化があった場合のみ、バッチ推定により、新たに位置の推定を行い、推定位置を記録するというものである。
【００８０】
図９におけるステップＳ１００の観測値取得処理は、図２Ａの物体位置推定装置２００における観測値取得部２０１により実行される動作に対応する。ステップＳ１００では、観測値取得部２０１が、図２Ａ及び図２Ｂの物品画像認識センサ２０９から出力される観測値を取得し、時刻管理部２０８から得た現在時刻を、観測時間として、この観測時間と観測値とを、観測値蓄積テーブル２０２に記録するとともに物品状態変化判定部２０３に出力する。
【００８１】
次に、ステップＳ２００の物品状態変化判定処理が、図２Ａの物体位置推定装置２００における物品状態変化判定部２０３により実行される。
【００８２】
ステップＳ２００の内部処理について、図１０のフローチャートを用いて説明する。
【００８３】
図１０のフローチャートにおいて、ステップＳ２０１からステップＳ２０２までの処理は、新たな物品が観測されたか、あるいは、置かれている物品が観測されなかったかという基準で、物品の存在状態変化があったかどうかを物品状態変化判定部２０３で判定する処理である。
【００８４】
ステップＳ２０３からステップＳ２０６は、物品が新たに置かれたときにどの物品が置かれたかを物品状態変化判定部２０３で判定する処理である。
【００８５】
ステップＳ２０７からステップＳ２０９は、物品が取られたときにどの物品が取られたかを物品状態変化判定部２０３で判定する処理である。
【００８６】
ステップＳ２１０は、物品の存在状態変化がなかったときの物品状態変化判定部２０３での処理である。  ステップＳ２０１では、現時刻において観測値取得部２０１から得られた複数の観測値と、物品位置推定値テーブル２０６に記録されている現時刻における最新の物品毎の物品位置推定値との、すべての組み合わせに対して、以下の（式１）で定義されるアソシエーション尤度を物品状態変化判定部２０３で計算する。物品位置推定値の数をＮとし、得られている観測値の数をＭとすると、Ｍ×Ｎ個のアソシエーション尤度を物品状態変化判定部２０３で計算することになる。
【００８７】
【数１】
2011108055.tif 000041
【００８８】
アソシエーション尤度は、実際の物品と観測値との対応の確からしさを表す値であり、確率論として数学的に定式化できる。（式１）の左辺において、物品位置推定値の数をＮとすると、ＸはＮ個分の物品位置推定値の結合ベクトルであり、ｙは、観測ＩＤ尤度ｙＩＤと観測位置ｙｐｏｓを結合した観測値のベクトルである。ｒは、ｙがＮ個の物品のうち、どの物品を観測したかを表す状態変数で、ｒ＝ｊの場合物品ＩＤがｊの物品を観測したということを意味する。（式１）の左辺は、ある物品位置推定値ベクトルＸが与えられ、物品ｊを観測したとしたときに、観測値ベクトルｙが得られる条件付き確率である。
【００８９】
（式１）の右辺ｐｐｏｓ（ｙｐｏｓ｜Ｘ，ｒ＝ｊ）は、観測値ベクトルｙの観測位置であるｙｐｏｓのｊ番目の物品の位置に対する尤度を表している。そして、（式１）の右辺のｐＩＤ（ｙＩＤ｜Ｘ，ｒ＝ｊ）は、観測値のうち観測ＩＤ尤度に相当する項である。本第１実施形態では、このように（式１）の右辺で表現している通り、物品の位置の尤度と観測ＩＤ尤度とは互いに独立とするモデルにより、定式化する。
【００９０】
【数２】
2011108055.tif 000042
【００９１】
（式２）は、（式１）のｐｐｏｓ（ｙｐｏｓ｜Ｘ，ｒ＝ｊ）を定義する式である。本第１実施形態においては、物品画像認識センサ２０９の位置誤差特性は、３次元の正規分布で近似できるものとする。（式２）において、ｄは位置の座標の次元数でありｄ＝３である。ｘは物品ＩＤがｊである物品の推定位置の３次元座標値、ｙｐｏｓは観測値の観測位置の３次元座標値を表す。Σは３×３の行列で物品画像認識センサ２０９の位置誤差特性を表す共分散行列である。特に、各次元の位置誤差の間に相関がない場合は、対角成分が各次元の誤差の分散となる対角行列となる。このΣについては、物品画像認識センサ２０９で物品の位置計測実験を予め行って求めておく。
【００９２】
【数３】
2011108055.tif 000043
【００９３】
（式３）は（式１）のｐＩＤ（ｙＩＤ｜Ｘ，ｒ＝ｊ）を定義する式である。ここでＣｊは、物品画像認識センサ２０９の物品ＩＤがｊの物品に関する識別率である。また、Ｎは観測の対象となる物品の数である。本第１実施形態では、観測ＩＤ尤度が（式３）の式で定式化されているものとする。すなわち、物品ＩＤがｊの物品を観測した際には、観測ＩＤ尤度の物品ＩＤがｊに関する尤度は、Ｃｊであり、物品ＩＤがｊではない物品ＩＤに関する尤度は、（１−Ｃｊ）／（Ｎ−１）で得られるとする。この定義では、物品ＩＤがｊ以外の物品を観測したときに、物品ＩＤがｊの物品であると誤識別する確率は、物品ＩＤがｊ以外の物品に関して、すべて同じであるとして扱っている。Ｃｊの値については、物品画像認識センサ２０９に関する説明で述べた通り、物品画像認識センサ２０９で物品の識別実験を予め行って求めておく。
【００９４】
図１５，図１６、及び、図１７にステップＳ２０１で計算したアソシエーション尤度の例を示す。
【００９５】
図１５は、物品ＩＤ＝０００４が置かれた時刻ｔ１における計算結果である。具体的には、現時刻が時刻ｔ１であるとすると、図１３の時刻ｔ１での観測値１３０１と、図１９の、時刻ｔ１における最新の時刻である時刻ｔ０での物品位置推定値との組み合わせに関して計算される。なお、図１９の時刻ｔ０は図１４のチャート１４Ａには記載されていないが、時刻ｔ０は、時刻ｔ１より前の時刻であって、物品ＩＤ＝０００４が取られた際にバッチ推定によって得られた物品位置推定値が記録された時刻である。
【００９６】
図１６は、物品の存在状態変化が無い時刻ｔ４における計算結果である。図１３の時刻ｔ４における観測値１３０２と、時刻ｔ４より前の図１９の時刻ｔ１における物品位置推定値との組み合わせに関して計算される。
【００９７】
図１７は、物品ＩＤ＝０００４が持ち去られた時刻ｔ５における計算結果である。図１３の時刻ｔ５における観測値１３０３と、時刻ｔ５より前の図１９の時刻ｔ１における物品位置推定値との組み合わせに関して計算される。
【００９８】
ステップＳ２０２では、ステップＳ２０１で尤度を計算するのに用いた観測値数Ｍと物品位置推定値数Ｎとを物品状態変化判定部２０３で比較して、条件分岐を行う。
【００９９】
条件分岐の内容は、
１）Ｍ＞Ｎの場合は、ステップＳ２０３に進む（新たに物品が置かれた場合）、
２）Ｍ＝Ｎの場合は、ステップＳ２１０に進む（物品の存在状態に変化が無い場合）、
３）Ｍ＜Ｎの場合は、ステップＳ２０７に進む（物品が取られた場合）、
の３つである。図１４の時刻ｔ１，ｔ４，ｔ５においてアソシエーション尤度を計算した結果が、それぞれ図１５，図１６，図１７である。ステップＳ２０２において、時刻ｔ１ではＮ＝３，Ｍ＝４で前記１）の条件分岐になり、時刻ｔ４ではＮ＝４，Ｍ＝４で前記２）の条件分岐になり、時刻ｔ５ではＮ＝４，Ｍ＝３で前記３）の条件分岐となる。
【０１００】
次に、新たに物品が置かれた場合の処理に相当するステップＳ２０３からステップＳ２０６までの処理について説明する。処理の具体例として、図１５に示す時刻ｔ１における尤度の計算結果に基づいて説明する。
【０１０１】
ステップＳ２０３からステップＳ２０６までの処理の流れをまず簡単に説明すると、ステップＳ２０３とステップＳ２０４とで、現在置かれている物品には対応しない観測値が、どの観測値であるか、を物品状態変化判定部２０３で決定する。次に、ステップＳ２０５で、物品に対応しない観測値が、どの物品を観測したものであるか、を物品状態変化判定部２０３で決定し、ステップＳ２０６で物品存在状態判定結果として物品状態変化判定部２０３から出力する、というものである。
【０１０２】
ステップＳ２０３では、ステップＳ２０１で計算した尤度に対して物品位置推定値の物品ＩＤを固定した上で、アソシエーション尤度の大きさの順序を物品状態変化判定部２０３で決定する。例えば、物品状態変化判定部２０３により、図１５の尤度の計算結果の表の列方向に尤度の大きさを比較して順序を決定する。
【０１０３】
次いで、ステップＳ２０４では、物品状態変化判定部２０３により、ステップＳ２０３でアソシエーション尤度の順序を決定した後、どの物品ＩＤに関してもアソシエーション尤度が最大とならない観測値を特定する。
【０１０４】
図１５のアソシエーション尤度の計算結果の表では、背景が灰色の箇所１５０１，１５０２，１５０３が、ステップＳ２０３で順序を決定した結果、最大となったアソシエーション尤度である。ここで、観測値１は、物品ＩＤ＝０００１の位置推定値に関してアソシエーション尤度が最大である（図１５の１５０１の欄参照）。観測値２は、物品ＩＤ＝０００２の位置推定値に関してアソシエーション尤度が最大である（図１５の１５０２の欄参照）。観測値３は、物品ＩＤ＝０００３の位置推定値に関してアソシエーション尤度が最大である（図１５の１５０３の欄参照）。しかし、観測値４は、どの物品に関しても、最大となるアソシエーション尤度がない。よって、観測値４が、ステップＳ２０４で特定される観測値となると物品状態変化判定部２０３により判定する。
【０１０５】
次いで、ステップＳ２０５では、ステップＳ２０４で特定された観測値の観測ＩＤ尤度の中で最も尤度が高い物品ＩＤを物品状態変化判定部２０３により特定する。
【０１０６】
図１５のアソシエーション尤度の計算結果に基づいて、ステップＳ２０４では観測値４が特定されている。観測値４は、図１３の中の１３０１の観測値の上から４番目の観測値であり、観測ＩＤ尤度が最大の物品ＩＤは０００４である。従って、ステップＳ２０５では物品ＩＤが０００４と物品状態変化判定部２０３により特定される。
【０１０７】
次いで、ステップＳ２０６では、ステップＳ２０５で特定された物品ＩＤを持つ物品が、「新たに置かれた物品である」ことが、物品状態変化判定部２０３により決定され、ステップＳ２００の出力として「当該物品ＩＤが置かれた」という物品存在状態変化判定結果を、物品状態変化判定部２０３が出力する。
【０１０８】
図１５のアソシエーション尤度の計算結果に基づくと、ステップＳ２０３からステップＳ２０６の一連の処理の結果として、物品状態変化判定部２０３は、物品ＩＤが０００４の物品がＰＵＴされたこと（置かれたこと）を出力する。
【０１０９】
次に、物品存在状態に変化が無い場合に相当するステップＳ２１０の処理について説明する。ここでは物品状態変化判定部２０３の出力として、物品存在状態変化なしを出力する。図１４の時刻ｔ４の時点では、物品の存在状態変化が無かったと判定される。
【０１１０】
次に、物品が取られた場合に相当するステップＳ２０７からステップＳ２０９までの処理について説明する。処理の具体例として、図１７に示す時刻ｔ５における尤度の計算結果に基づいて説明する。
【０１１１】
ステップＳ２０７からステップＳ２０９までの処理の流れをまず簡単に説明すると、ステップＳ２０７とステップＳ２０８とで、得られた観測値と対応しない物品が、どの物品か、を物品状態変化判定部２０３で決定する。次に、ステップＳ２０９では、ステップＳ２０８で決定した、物品ＩＤが取られたという物品存在状態判定結果を物品状態変化判定部２０３から出力するというものである。
【０１１２】
ステップＳ２０７では、ステップＳ２０１で計算したアソシエーション尤度に対して、観測値を１つに固定した上で、アソシエーション尤度の大きさの順序を物品状態変化判定部２０３で決定する。例えば、物品状態変化判定部２０３により、図１７のアソシエーション尤度の計算結果の表の行方向に尤度の大きさを比較し順序を決定する。
【０１１３】
次いで、ステップＳ２０８では、物品状態変化判定部２０３により、ステップＳ２０７でアソシエーション尤度の順序を決定した後、どの観測値に関してもアソシエーション尤度が最大とならない物品ＩＤを特定する。
【０１１４】
図１７の例で説明すると、背景が灰色の箇所１７０１，１７０２，１７０３が、ステップＳ２０７で順序を決定した結果、最大となったアソシエーション尤度である。ここで、物品ＩＤ＝０００１の位置推定値は、観測値１に関してアソシエーション尤度が最大である（図１７の１７０１の欄参照）。物品ＩＤ＝０００２の位置推定値は、観測値２に関してアソシエーション尤度が最大である（図１７の１７０２の欄参照）。物品ＩＤ＝０００３の位置推定値は、観測値３に関してアソシエーション尤度が最大である（図１７の１７０３の欄参照）。しかし、物品ＩＤ＝０００４の位置推定値は、どの観測値に関しても、最大となるアソシエーション尤度がない。よって、物品ＩＤの０００４が、ステップＳ２０８で特定される物品ＩＤとなると物品状態変化判定部２０３により判定する。
【０１１５】
次いで、ステップＳ２０９では、ステップＳ２０８で特定された物品ＩＤを持つ物品が、「取られた物品である」と物品状態変化判定部２０３により決定し、ステップＳ２００の出力として「当該物品ＩＤが取られた」という物品存在状態変化判定結果を、物品状態変化判定部２０３から出力する。
【０１１６】
図１７のアソシエーション尤度の計算結果に基づくと、ステップＳ２０７からステップＳ２０９の一連の処理の結果として、物品状態変化判定部２０３は、物品ＩＤが０００４の物品がＴＡＫＥされた（取られた）ことを出力する。
【０１１７】
以上が、ステップＳ２００の物品状態変化判定処理の説明である。  再び、図９のフローチャートに戻り物体位置推定装置２００の処理ステップの説明を続ける。
【０１１８】
ステップＳ２００に続くステップＳ３００では、ステップＳ２００の処理で、物品存在状態の変化があると物品状態変化判定部２０３で判定された場合は、ステップＳ４００へ分岐し、物品存在状態の変化がないと物品状態変化判定部２０３で判定されれば、ステップＳ１００に戻る。
【０１１９】
ステップＳ４００では、ステップＳ２００で物品状態変化判定部２０３により決定された、物品状態変化判定部２０３からの物品存在状態変化の判定結果の出力に応じて、物品状態変化判定部２０３により物品状態変化情報テーブル２０４に物品存在状態の変化を記録する。記録する内容は、物品状態変化情報テーブル２０４の説明のとおりである。
【０１２０】
ステップＳ５００は、物品存在状態に変化があった場合に、バッチ推定部２０５が行う物品位置のバッチ推定処理である。
【０１２１】
ステップＳ５００の内部の処理フローを、図１１のフローチャートで説明する。
【０１２２】
図１１のステップＳ５０１においては、まず、物品状態変化があったと物品状態変化判定部２０３で判定された際に取得された時刻から、あらかじめ定められた時間の間、観測値取得部２０１で観測値を取得し、観測値蓄積テーブル２０２に観測値を記録するよう、バッチ推定部２０５が観測値取得部２０１に指令する。
【０１２３】
なお、ここで、観測値を取得する時間（あるいは、取得する回数）については、実験により所望の位置精度（位置に関するバラツキの上限）が予め得られるように、また、バッチ処理による位置推定処理が完了するまでの時間が、対象とする物品の状態変化の頻度上、問題とならない範囲になるように定めるものとする。
【０１２４】
例えば、本第１実施形態における物体位置推定装置２００で、位置の推定対象とする物品に関して、物品を静止状態にした上で、物品画像認識センサ２０９から観測値を観測値取得部２０１で取得する時間を変化させた上で（あるいは、観測値を取得する回数を変化させた上で）、バッチ推定部２０５でバッチ推定処理を行わせ、必要とする位置精度が得られる最小の観測値の取得時間（例えば数秒、あるいは、最小の観測値の取得回数）を、一定の時間（あるいは回数）と定める。
【０１２５】
ステップＳ５０２では、ステップＳ２００で物品状態変化があったことを判定した際に用いた観測値と、ステップＳ５０１で一定時間、複数回取得した観測値とを合わせて観測値蓄積テーブル２０２から取得し、バッチ推定部２０５により、バッチ推定による物品位置推定を行う。
【０１２６】
バッチ推定の方法としては、複数の物品と複数の観測値との対応関係を確率的に取り扱うことが可能な推定アルゴリズムを用いる。バッチ推定部２０５による推定アルゴリズムの一例としては、例えば（非特許文献１：Hirofumi Kanazaki，Takehisa Yairi，Junichi Shibata，Yohei Shirasaka and Kazuo Machida，"Localization and Identification of Multiple Objects with Heterogeneous Sensor Data by EM Algorithm"，SICE-ICASE International Joint Conference (SICE-ICCAS) 2006）で開示されている方法を用いることができる。本第１実施形態では、物品画像認識センサ２０９で得られる観測値に、物品の識別に関する尤度（観測ＩＤ尤度）を含むので、前記非特許文献１で開示されているデータアソシエーションの枠組みを組み込んだＥＭアルゴリズムを適用することが可能である。
【０１２７】
ここで、非特許文献１で開示されているアルゴリズムを用いたバッチ推定処理の概要について、補足説明する。
【０１２８】
以下の補足説明において、ＸはＮ個分の物品位置推定値の結合ベクトルであり、ｘｊ，ｐｏｓは、ｊ番目の物品推定位置とする。Ｙは、バッチ推定の入力となるＭ個の観測値の結合ベクトルであり、i番目の観測値をｙiとする。ｙiは、観測ＩＤ尤度ｙＩＤと観測位置ｙｐｏｓを結合した観測値のベクトルとする。さらに、ｒｊは観測値ｙiがどの物品を観測したかを表わす状態変数である。（例えばｒｉ＝ｊである場合は、観測値ｙiは、ｊ番目の物品を観測したという状態を表す。）なお、ここでのＸ，Ｙ、ｒに関する定義は、本実施形態における物品位置の推定値、物品の観測値（物品ＩＤ尤度、および、観測値）、観測値がどの物品を観測したかを表す状態変数の定義と同じ意味であるので、以下説明する具体的なバッチ推定アルゴリズムを、本実施形態でのバッチ推定部２０５のバッチ推定方式として使えることを述べておく。
【０１２９】
以下説明するバッチ推定アルゴリズムは、ＭＡＰ推定法（事後確率最大化推定法）と呼ばれるものであり、ｐ（Ｘ｜Ｙ）で表される確率を最大化するＸの値（Ｘ＝Ｘ＊）を求めることにより、Ｘすなわち、物品位置の推定を行うものである。
【０１３０】
【数４】
2011108055.tif 000044
【０１３１】
この（式４）のＭＡＰ推定で得られるＸ＊の意味するところは、観測データＹを得た時、Ｘ＝Ｘ＊において、ｐ（Ｘ｜Ｙ）が最大になるとすれば、Ｘ＊が最も確からしいＸの値であることである。すなわち、Ｘ＊が物品位置として尤も確からしい位置を与えることになる。
【０１３２】
ベイズの定理により、ｐ（Ｘ｜Ｙ）は、次のように変形される。
【０１３３】
【数５】
2011108055.tif 000045
【０１３４】
（式５）のように変形した上で、ＭＡＰ推定をＥＭアルゴリズムによって行う。ＥＭアルゴリズムは、Ｅ−Ｓｔｅｐ（推定ステップ）,Ｍ−Ｓｔｅｐ（最大化ステップ）という２つの計算ステップを繰り返すことにより、ＭＡＰ推定を実行するアルゴリズムである。Ｘ（ｔ）を、ＥＭアルゴリズムの繰り返し計算のｔ番目の計算によって得られた物品位置Ｘの推定値であるとする。（式５）のように変形されたｐ（Ｘ｜Ｙ）のＭＡＰ推定を行うＥＭアルゴリズムを以下に示す。
【０１３５】
【数６】
2011108055.tif 000046
【０１３６】
ここで、本実施形態の（式１）の定義から、ｐ（ｙｉ｜Ｘ，ｒｉ＝ｊ）＝ＰＩＤ（ｙｉ，ＩＤ｜Ｘ，ｒｉ＝ｊ）・ｐｐｏｓ（ｙｉ，ｐｏｓ｜ｒｉ＝ｊ）となるので、（式６）に代入すると、
【０１３７】
【数７】
2011108055.tif 000047
【０１３８】
となる。この変形において、Ｎ個の物品は同じ頻度で観測されるので、（式６）においてｐｐｏｓ（ｒｉ，ｐｏｓ｜Ｘ）＝１／Ｎとおいた。
【０１３９】
（式７）のＱ（Ｘ｜Ｘ（ｔ））に関して、（式６）のＭ−Ｓｔｅｐすなわち、Ｑ（Ｘ｜Ｘ（ｔ）が最大になるＸを求めるために、
【０１４０】
【数８】
2011108055.tif 000048
【０１４１】
を解くことで、
【０１４２】
【数９】
2011108055.tif 000049
【０１４３】
を得る。
【０１４４】
さらに、（式６）のαに関して、
【０１４５】
【数１０】
2011108055.tif 000050
【０１４６】
を得る．この変形においてもｐｐｏｓ（ｙｉ，ｐｏｓ｜Ｘ）＝１／Ｎとおいた。なお、（式９）の右辺は本実施形態の（式１）、（式２）、（式３）において、Ｘ＝Ｘ（ｔ＋１）代入することにより得られる。ここで得られた（式８）、（式９）がＸ（ｔ）からＸ（ｔ＋１）を求める更新式であり、この更新式に基づいた繰り返し計算により、Ｘ＊を求めることができる。
【０１４７】
この繰り返し計算における物品推定位置の初期値は、Ｘ（０）として与える。
【０１４８】
前記ステップＳ５０２でバッチ推定を開始する際の、物品位置推定の初期値の与え方について説明する。
【０１４９】
新たに物品が置かれた場合、存在状態変化の無かった物品については、物品位置推定値テーブル２０６に記録されている最新の物品位置推定値を物品位置推定の初期値としてバッチ推定部２０５で用いる。新たに置かれた物品に関する物品位置推定処理での推定位置の初期値としては、ステップＳ２０４で特定された観測値の観測位置をバッチ推定部２０５で用いる。物品が取られた場合は、取られた物品以外の物品を存在状態変化が無かったとして、バッチ推定部２０５で扱う。
【０１５０】
ステップＳ５０３では、ステップＳ５０２で得られた各物品の推定位置をバッチ推定結果としてバッチ推定部２０５から出力する。
【０１５１】
以上が、ステップＳ５００でのバッチ推定部２０５が行う物品位置のバッチ推定処理の説明である。
【０１５２】
再び、図９のフローチャートに戻る。
【０１５３】
ステップＳ５００に続くステップＳ６００は、ステップＳ５００においてバッチ推定部２０５の推定結果から判明する物品の存在状態と、ステップＳ２００において物品状態変化判定部２０３で判定した物品の存在状態との間に矛盾が生じているかをバッチ推定部２０５で判定する。
【０１５４】
ステップＳ６００において、矛盾が生じているとバッチ推定部２０５で判定された場合は、ステップＳ７００において、バッチ推定部２０５から得た推定結果に基づき、バッチ推定部２０５により、物品状態変化情報テーブル２０４内の物品の存在状態を書き換える。
【０１５５】
ここで、ステップＳ６００におけるバッチ推定部２０５での判定処理、及び、ステップＳ７００におけるバッチ推定部２０５による物品状態変化情報テーブル２０４内の物品の存在状態の書き換えが必要な理由を説明する。
【０１５６】
ステップＳ２００において物品が追加されたときの処理フローの中のステップＳ２０５において、既に存在する物品に対応しない観測値の観測ＩＤ尤度で最大の物品ＩＤを追加された物品のＩＤであると物品状態変化判定部２０３で特定している。このとき、一時的なオクルージョン又は観測する空間の照明の変動などの物品観測上の外乱により、物品画像認識センサ２０９が物品の識別誤りを起こす可能性がある。識別誤りを起こした場合は、本当に追加された物品ＩＤではない物品ＩＤの尤度が高くなり、その結果、ステップＳ２００において物品状態変化判定部２０３は、誤った物品ＩＤの物品が追加された物品であると誤って判定し、ステップＳ４００において、物品状態変化情報テーブル２０４に誤った物品ＩＤの物品がＰＵＴされたと、物品状態変化判定部２０３により記録されてしまう。
【０１５７】
しかし、ステップＳ５００において、バッチ推定部２０５により一定時間内の複数の観測値に基づいて物品位置の推定処理を行うので、一時的な外乱による物品の識別誤りの影響が抑えられ、最終的に正しい物品ＩＤの物品が追加されたことがバッチ推定部２０５により判明する。
【０１５８】
したがって、ステップＳ６００において、ステップＳ５００のバッチ推定処理により得られた正しい物品の存在状態と、物品状態変化情報テーブル２０４に記録された物品の存在状態とをバッチ推定部２０５で比較し、両者が異なるとバッチ推定部２０５で判定した場合は、ステップＳ７００において、物品状態変化情報テーブル２０４の内容をステップＳ５００のバッチ推定処理の結果に基づいてバッチ推定部２０５が書き換える。
【０１５９】
ステップＳ６００で、前記したように矛盾が発生し、ステップＳ７００で書き換えを行う具体例については、後で詳しく説明する。
【０１６０】
ステップＳ６００で矛盾がないとバッチ推定部２０５で判定された場合、又は、ステップＳ７００において、物品状態変化情報テーブル２０４の内容をステップＳ５００のバッチ推定処理の結果に基づいてバッチ推定部２０５が書き換えた後は、ステップＳ８００に進む。
【０１６１】
ステップＳ８００は、ステップＳ５００でバッチ推定部２０５により推定された物品毎の物品位置推定値を、物品位置推定値テーブル２０６にバッチ推定部２０５により記録する。記録される位置推定値については、物品位置推定値テーブル２０６の説明で述べた通りである。ステップＳ８００の処理の後は、一連の物体位置推定処理動作を終了するか、又は、図示のように、ステップＳ１００へ戻る。
【０１６２】
ここまでで説明した、物体位置推定装置２００の動作フロー（図９、図１０、及び、図１１）の主要な処理ステップに関して、物品の存在状態変化に応じてどのようなタイミングで各処理が行われるかについて、タイミングチャート形式で簡単に触れておく。
【０１６３】
図１４の下半分のチャート１４Ｂは、図９、図１０、及び、図１１に示した物体位置推定装置２００の処理フローの主な処理ステップが動作するタイミングを示すチャートである。この物体位置推定装置２００の動作シーケンスのタイミングチャートであるチャート１４Ｂは、物品の状態変化の時間経過を表すチャート１４Ａと時間軸（横軸）を共有している。チャート１４Ｂにおいて、「▲」は短時間で行われる処理ステップが動作したタイミングを表し、実線矢印は、短時間処理のステップが繰り返し行われる期間、あるいは、一定時間継続する処理ステップが動作しているタイミングを表す。
【０１６４】
物品の状態変化が起こっていない期間（ｔ＜ｔ１，ｔ３＜ｔ＜ｔ５，ｔ７＜ｔ＜ｔ８，ｔ１０＜ｔ＜ｔ１１，ｔ１３＜ｔ＜ｔ１４，ｔ１６＜ｔ）は、ステップＳ１００〜ステップＳ３００の観測値取得と物品の状態変化の判定処理とが繰り返し行われる。
【０１６５】
物品状態変化（物品存在状態変化）が起こったタイミング（ｔ＝ｔ１，ｔ５，ｔ８，ｔ１１，ｔ１４）では、ステップＳ４００を経てステップＳ５００でバッチ推定部２０５による物品の位置推定処理が行われる。ステップＳ５００で複数の観測値を取得し（ステップＳ５０１）、バッチ推定処理（ステップＳ５０２）が完了した後、ステップＳ８００で、バッチ推定で得られた物品位置推定値を、物品位置推定値テーブル２０６に記録したのち、ステップＳ１００に戻り、ステップＳ１００〜ステップＳ３００の繰り返しが再開される。
【０１６６】
なお、図１８は時刻ｔ＝ｔ１６の時点での、物品状態変化情報テーブル２０４の内容を表し、図１９は、同じく時刻ｔ＝ｔ１６の時点での、物品位置推定値テーブル２０６の内容を表す。
【０１６７】
図１４のタイミングチャートにおいて、ｔ＝ｔ８においては、物品ＩＤ＝０００１、物品ＩＤ＝０００２の２つの物品が同時に取られるケースが生じている。この場合においても、図１０のフローチャートのステップＳ２０１からステップＳ２０９に至る処理フローを通じて、次のように２つの物品が取られたことが判定される。
【０１６８】
ｔ＝ｔ８において得られた１つの観測値（図１３の１３０４）と、その時点での最新の物品位置推定値（図１９のｔ＝ｔ５の物品位置推定値）に関して、ステップＳ２０１でアソシエーション尤度の計算が物品状態変化判定部２０３でなされ、ステップＳ２０２では、物品位置推定値の個数Ｎ＝３に対して、観測値の個数Ｍ＝１であるため、物品が取られたと物品状態変化判定部２０３で判定される。
【０１６９】
図２０に時刻ｔ８におけるアソシエーション尤度の計算結果を示す。このアソシエーション尤度に基づいて、ステップＳ２０７及びステップＳ２０４の処理において、物品ＩＤ＝０００１及び物品ＩＤ＝０００２の両方が、この１つ得られている観測値（図１３の１３０４）に対して、尤度が最大ではないので、この２つの物品が取られたと物品状態変化判定部２０３で判定される。
【０１７０】
図１４のタイミングチャートにおいて、ｔ１０＜ｔ＜ｔ１１の期間では、物品ＩＤ＝０００１、物品ＩＤ＝０００２、物品ＩＤ＝０００４の３つが取られている状態であり、ｔ＝ｔ１１で、その内の１つ置かれた（図１４では物品ＩＤ＝０００１が置かれた）という状況が発生している。ｔ＝ｔ１１において、物品ＩＤ＝０００１、物品ＩＤ＝０００２、物品ＩＤ＝０００４のうち、どの物品が置かれたかの物品状態変化判定部２０３での判定については、図１０のフローチャートのステップＳ２０１からステップＳ２０６に至る処理フローを通じて、物品状態変化判定部２０３で、次のように解決される。
【０１７１】
まず、ｔ＝ｔ１１において得られた２つの観測値（図１３の１３０５）と、その時点での最新の物品位置推定値（図１９のｔ＝ｔ８の物品位置推定値）に関して、ステップＳ２０１でアソシエーション尤度の計算が物品状態変化判定部２０３でなされ、ステップＳ２０２では、物品位置推定値の個数Ｎ＝１に対して、観測値の個数Ｍ＝２であるため、物品が置かれたと物品状態変化判定部２０３で判定される。
【０１７２】
ステップＳ２０３及びステップＳ２０４の処理では、物品ＩＤ＝０００２の位置推定値、あるいは、と物品ＩＤ＝０００３の位置推定値のどちらに関しても、アソシエーション尤度が最大にならない観測値（図１３の１３０５の上から１番目）が物品状態変化判定部２０３で特定される。
【０１７３】
ステップＳ２０５では、その特定された観測値の、観測ＩＤ尤度のうち、値が最大になる物品ＩＤは、０００１であるため、物品ＩＤは０００１と物品状態変化判定部２０３で特定され、物品ＩＤ＝０００４ではなく、物品ＩＤ＝０００１が置かれたことが物品状態変化判定部２０３で判定できる。
【０１７４】
ここで、図９のフローのステップＳ６００及びステップＳ７００の処理を具体例に基づいて補足説明する。
【０１７５】
図１４のタイミングチャートにおいて、ｔ＝ｔ１４において、物品ＩＤ＝０００４が置かれている。このとき（ｔ＝ｔ１４）の物品の観測値は、図１３の１３０６である。観測値１３０６の上から３つ目の観測値は、ｔ＝ｔ１４で置かれた物品ＩＤ＝０００４に対応するものだが、物品画像認識センサ２０９の物品の識別誤りにより、ＩＤ＝０００４ではなくＩＤ＝０００２の観測ＩＤ尤度が最大になっている。
【０１７６】
観測値１３０６と、その時点での最新の物品位置推定値（図１９のｔ＝ｔ１１の物品位置推定値）に関して、ステップＳ２０１でアソシエーション尤度の計算が物品状態変化判定部２０３でなされ、ステップＳ２０２では、物品位置推定値の個数Ｎ＝２に対して、観測値の個数Ｍ＝３であるため、物品が置かれたと物品状態変化判定部２０３で判定される。
【０１７７】
図２１にｔ＝ｔ１４におけるアソシエーション尤度の計算結果を示す。ステップＳ２０３、ステップＳ２０４の処理では、この図２１の尤度の計算結果に基づき、物品ＩＤ＝０００１の位置推定値、あるいは、物品ＩＤ＝０００３の位置推定値のどちらに関しても、アソシエーション尤度が最大にならない観測値（図１３の１３０６の上から３番目）が物品状態変化判定部２０３で特定される。ステップＳ２０５では、その特定された観測値の、観測ＩＤ尤度のうち、値が最大になる物品ＩＤは、上述の通り、ＩＤ＝０００２であるため、物品ＩＤは０００２と物品状態変化判定部２０３で特定され、図９のステップＳ２００では、物品ＩＤ＝０００２が置かれたと物品状態変化判定部２０３で判定される。
【０１７８】
そして、ステップＳ４００では、物品状態変化情報テーブル２０４に、物品ＩＤ＝０００２がＰＵＴされたと物品状態変化判定部２０３で記録される。
【０１７９】
次に、ステップＳ５００のバッチ推定処理では、複数回数に渡る観測値を入力として、物品位置の推定を行うので、一時的に物品の識別誤りを含んだ観測値１３０６以降に得られる識別誤りのない観測値と合わせて、バッチ推定部２０５が推定することにより、物品ＩＤ＝０００４を物品ＩＤ＝０００２に識別誤りした観測値１３０６の影響は抑えられ、推定結果として物品ＩＤ＝０００１、物品ＩＤ＝０００３、物品ＩＤ＝０００４が存在するという推定結果がバッチ推定部２０５により得られる。
【０１８０】
そこで、ステップＳ６００では、物品状態変化情報テーブル２０４に記録された物品状態変化情報をバッチ推定部２０５が参照し、物品ＩＤ＝０００２がＰＵＴされたという情報が、バッチ推定処理結果と矛盾するというバッチ推定部２０５での判定になる。そのため、ステップＳ７００において、物品状態変化情報テーブル２０４に記録された物品ＩＤ＝０００２がＰＵＴされたという情報をバッチ推定部２０５で削除し、物品状態変化情報テーブル２０４内において物品ＩＤ＝０００４がＰＵＴされたという情報にバッチ推定部２０５で書き換える。
【０１８１】
よって、物品画像認識センサ２０９の一時的な物品の識別情報の誤りにより、物品状態変化判定部２０３が、物品状態の変化の判定を誤っても、バッチ推定部２０５での複数観測値による物品位置推定処理により、物品状態変化情報テーブル２０４に記録される物品状態情報が正しく訂正される。
【０１８２】
最後に、物品位置表示ディスプレイ２１０の動作について、図１２のフローチャートで説明する。なお、図９に示される処理フローと、図１２の処理フローとは、互いに独立に（非同期）に動作するものとする。
【０１８３】
図１２のステップＳ９００では、物品位置表示操作用マウス２１１を使用することにより、ユーザが物品の位置を知りたい時刻の設定を物品位置表示ディスプレイ２１０で受け付ける。具体的には、物品位置表示ディスプレイ２１０の画面（図８）で、ユーザがマウスポインタ８０４を操作し、矩形領域８０３の「戻る」ボタン、あるいは、「進む」ボタンをクリックする、あるいは、クリックし続けることで、矩形領域８０３の右端の時刻ｔを変化させ、ユーザがクリック状態を解放したタイミングで表示されている時刻ｔを、ユーザが物品位置を知りたい時刻として物品位置表示ディスプレイ２１０で設定する。
【０１８４】
次いで、ステップＳ１０００では、ステップＳ９００で設定した時刻における物品位置の情報を物品位置表示ディスプレイ２１０から物品位置推定値出力部２０７に対して要求する。
【０１８５】
次いで、ステップＳ１１００では、物品位置推定値出力部２０７が、要求された時刻における物品位置推定値の情報を、物品位置推定値テーブル２０６から取得し、物品位置表示ディスプレイ２１０に出力する。
【０１８６】
次いで、ステップＳ１２００では、物品位置表示ディスプレイ２１０で受け取った物品の位置推定値、さらに、どの物品が持ち運び中であるかの情報を、物品位置表示ディスプレイ２１０の表示画面２１０ａの矩形領域８０１、及び、矩形領域８０２に表示する。
【０１８７】
図１４のチャート１４Ａに示すように物品の状態が変化した場合には、ユーザにより指定される時刻ｔの値により、図２２Ａ〜図２２Ｆに示すような形で物品の推定位置の表示が変化する。図２２Ａは時刻ｔ＜ｔ１（例えばｔ＝ｔ０）のときの物品の推定位置の表示を示す画面である。図２２Ｂは時刻ｔ１≦ｔ＜ｔ５のときの物品の推定位置の表示を示す画面である。図２２Ｃは時刻ｔ５≦ｔ＜ｔ８のときの物品の推定位置の表示を示す画面である。図２２Ｄは時刻ｔ８≦ｔ＜ｔ１１のときの物品の推定位置の表示を示す画面である。図２２Ｅは時刻ｔ１１≦ｔ＜ｔ１４のときの物品の推定位置の表示を示す画面である。図２２Ｆは時刻ｔ１４≦ｔのときの物品の推定位置の表示を示す画面である。
【０１８８】
前記第１実施形態にかかる構成によれば、物品状態変化判定部２０３により、複数の物品に対して得られる複数の観測値と、物品位置推定値テーブル２０６に記録される最新の複数の物品状態との対応関係の確からしさをアソシエーション尤度として計算することで、どの物品が置かれたか、又は、どの物品が取られたかを物品状態変化判定部２０３で判定することができる。これにより、物品の存在状態の変化の有無を検知することができ、物品の存在状態の変化があった場合のみ、バッチ推定部２０５で高精度に物品の位置を推定し、物品の存在状態の変化が無い間は、物品位置推定テーブル２０６に記録されているバッチ推定による高精度な物品位置推定結果を、物品位置推定結果として出力できる。
【０１８９】
すなわち、前記物体位置推定装置２００、及び、物体位置推定装置２００により実施される物体位置推定方法、及び、物体位置推定装置２００をプログラムとして構成する物体位置推定プログラムによれば、複数の準静止物品（例えば、静止と移動を繰り返すような物品）の観測において、移動から静止へと物品の状態が変化したタイミングで、バッチ推定により物品の位置を高精度で確定した後は、物品が静止している間は、バッチ推定によって得た高精度の位置情報を推定情報として出力することができるという格別の効果を有する。
【０１９０】
さらに、本発明の物体位置推定装置２００、及び、物体位置推定装置２００により実施される物体位置推定方法、及び、物体位置推定装置２００をプログラムとして構成する物体位置推定プログラムによれば、観測対象の物品の静止から移動、あるいは、移動から静止の状態変化を物品状態変化判定部２０３によって判断することにより、複数の物品すべてについて、観測中の任意の時刻における物品の静止、あるいは、移動の状態を把握することができるという効果も有する。
【０１９１】
なお、本発明は前記実施形態に限定されるものではなく、その他種々の態様で実施できる。
【０１９２】
例えば、本第１実施形態においては、物品位置の推定結果を物品位置表示ディスプレイ２１０に表示するとしたが、物品の推定位置の利用形態は、物品の位置を知ることを要求する他の装置への入力とすることももちろん可能であり、本発明の範囲を限定するものではない。
【０１９３】
また、例えば、物体としては、前記物品に限られるものではなく、人又はペットなどの動物でもよい。要するに、本発明で対象となる物体とは、人が搬送可能な物体を意味するものである。
【０１９４】
なお、前記実施形態において、物体状態変化判定手段１０１，２０３と、バッチ推定手段１０２，２０５と、物体状態情報記憶手段１０３，２０４，２０６となどのそれぞれ、又は、そのうちの任意の一部は、それ自体がソフトウェアで構成することができる。よって、例えば、本願明細書のそれぞれの実施形態の制御動作を構成するステップを有するコンピュータプログラムとして、記憶装置（ハードディスク等）などの記録媒体に読み取り可能に記憶させ、そのコンピュータプログラムをコンピュータの一時記憶装置（半導体メモリ等）に読み込んでＣＰＵを用いて実行することにより、前記した各機能又は各ステップを実行することができる。
【０１９５】
なお、前記様々な実施形態又は変形例のうちの任意の実施形態又は変形例を適宜組み合わせることにより、それぞれの有する効果を奏するようにすることができる。
【産業上の利用可能性】
【０１９６】
本発明に係る物体位置推定装置、物体位置推定方法、及び、物体位置推定プログラムは、観測対象の空間に存在し、任意のタイミングで持ち運ばれる可能性のある複数の物体（例えば複数の物品）の位置を推定する装置に利用可能である。例えば、家庭内の物品位置を管理するシステム、又は、ユーザから要求された物品を自律的に運搬する生活支援ロボットなどへの利用が可能である。
【０１９７】
本発明は、添付図面を参照しながら好ましい実施形態に関連して充分に記載されているが、この技術の熟練した人々にとっては種々の変形又は修正は明白である。そのような変形又は修正は、添付した請求の範囲による本発明の範囲から外れない限りにおいて、その中に含まれると理解されるべきである。
【手続補正２】
【補正対象書類名】特許請求の範囲
【補正対象項目名】全文
【補正方法】変更
【補正の内容】
【特許請求の範囲】
【請求項１】
観測対象の観測空間に存在する１つの物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、前記物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記物体の前記観測空間内での存在状態及び前記物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段により、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と、
を備える物体位置推定装置。
【請求項２】
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定手段と、
前記物体状態変化判定手段により、前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定手段と、
を備える物体位置推定装置。
【請求項３】
前記物体状態変化判定手段により、前記観測対象の前記物体が前記静止状態から移動状態に変化したと判定され、その後、前記移動状態から静止状態に変化したと判定されるまでの間は、前記バッチ推定手段が、前記当該物体の識別情報及び位置情報の推定を行わないとともに、推定値の出力も行わない、
請求項１又は２に記載の物体位置推定装置。
【請求項４】
前記物体状態変化判定手段により、前記観測対象の前記物体が移動状態から静止状態に変化したと判定され、その後、前記静止状態から移動状態に変化したと判定されるまでの間は、前記バッチ推定手段が、前記当該物体が前記静止状態に変化したと判定されたときに、前記当該物体の識別情報及び位置情報の推定を１度だけ行ったのち、その推定により得られた推定値を当該物体の物体状態情報として出力する、
請求項１又は２に記載の物体位置推定装置。
【請求項５】
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、物体状態変化判定手段により、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定ステップと、
前記物体状態変化判定ステップで前記物体の存在状態に変化があったと判定されたとき、前記物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、バッチ推定手段により、前記物体の識別情報及び位置情報の推定を行うバッチ推定ステップと、
を備える物体位置推定方法。
【請求項６】
コンピュータに、
観測対象の観測空間に存在する複数の物体の識別情報及び前記物体の位置情報を含む観測値が逐次得られる度に、複数の物体のうちの各物体の識別情報及び位置情報を含む前記観測値と、前記観測対象の前記各物体の前記観測空間内での存在状態及び前記各物体の位置に関する最新の推定値である物体状態情報との対応関係に基づいて、前記観測空間内での前記各物体が少なくとも静止状態にあるかどうかについて状態変化の有無を判定する物体状態変化判定機能と、
前記物体状態変化判定機能で前記物体の存在状態に変化があったと判定されたとき、物体状態変化判定手段が前記物体の存在状態に変化があったと判定した時刻から所定時間の間の観測値と、前記物体状態変化判定手段が決定した物体の存在状態とに基づき、前記物体の識別情報及び位置情報の推定を行うバッチ推定機能と、
を実現させるための物体位置推定プログラム。
【手続補正３】
【補正対象書類名】図面
【補正対象項目名】全図
【補正方法】変更
【補正の内容】
【図１】
2011108055.tif 000051
【図２Ａ】
2011108055.tif 000052
【図２Ｂ】
2011108055.tif 000053
【図３】
2011108055.tif 000054
【図４】
2011108055.tif 000055
【図５】
2011108055.tif 000056
【図６】
2011108055.tif 000057
【図７】
2011108055.tif 000058
【図８】
2011108055.tif 000059
【図９】
2011108055.tif 000060
【図１０】
2011108055.tif 000061
【図１１】
2011108055.tif 000062
【図１２】
2011108055.tif 000063
【図１３】
2011108055.tif 000064
【図１４】
2011108055.tif 000065
【図１５】
2011108055.tif 000066
【図１６】
2011108055.tif 000067
【図１７】
2011108055.tif 000068
【図１８】
2011108055.tif 000069
【図１９】
2011108055.tif 000070
【図２０】
2011108055.tif 000071
【図２１】
2011108055.tif 000072
【図２２Ａ】
2011108055.tif 000073
【図２２Ｂ】
2011108055.tif 000074
【図２２Ｃ】
2011108055.tif 000075
【図２２Ｄ】
2011108055.tif 000076
【図２２Ｅ】
2011108055.tif 000077
【図２２Ｆ】
2011108055.tif 000078
【国際調査報告】
2011108055.tif 000079
2011108055.tif 000080
2011108055.tif 000081
2011108055.tif 000082