JP6551615B2

JP6551615B2 - 位置推定装置及び位置推定方法

Info

Publication number: JP6551615B2
Application number: JP2018553697A
Authority: JP
Inventors: 西村　哲; 哲西村
Original assignee: Murata Manufacturing Co Ltd
Current assignee: Murata Manufacturing Co Ltd
Priority date: 2016-11-29
Filing date: 2017-10-10
Publication date: 2019-07-31
Anticipated expiration: 2037-10-10
Also published as: US10859671B2; WO2018100892A1; US20190257917A1; JPWO2018100892A1

Description

本発明は移動体の位置推定装置及び位置推定方法に関し、特には、移動体から発せられる電波の複数の固定局における受信強度に基づいて当該移動体の位置を推定する技術に関する。

位置が既知である複数の固定局のそれぞれから移動体までの距離を測定し、測定された距離に基づいて当該移動体の位置を特定する、３辺測量と呼ばれる技術がある。固定局から移動体までの距離は、例えば、固定局及び移動体の一方が発した電波を他方で受信したときの当該電波の受信強度（ＲＳＳＩ：ＲｅｃｅｉｖｅｄＳｉｇｎａｌＳｔｒｅｎｇｔｈＩｎｄｉｃａｔｏｒ）に基づいて測定される。

図１は、３辺測量の基本的な考え方を説明する図である。図１に示されるように、３辺測量では、固定局ａ、固定局ｂ、固定局ｃを中心とし、かつ固定局ａ、固定局ｂ、固定局ｃから移動体までの距離ｄ_ａ、距離ｄ_ｂ、距離ｄ_ｃを半径とする３つの円（以下、存在円と言う）の交点を、移動体の推定位置として特定する。

実際的な３辺測量では、距離ｄ_ａ、距離ｄ_ｂ、距離ｄ_ｃは測定誤差を含むため、３つの存在円は必ずしも１点で交わらない。そのため、移動体の推定位置を絞り込み、特定するための計算処理が必要になる。特に、距離の測定にＲＳＳＩを用いる位置推定では、ＲＳＳＩの変動が大きく得られる距離の精度が低いことから、各種の計算処理の適用が検討されている（例えば、特許文献１、２）。

特許文献１では、移動体の推定位置を、互いに異なる固定局を中心とし、ＲＳＳＩに基づく最小距離と最大距離とで規定される複数の円環領域の重複部分に絞り込んでいる。また、ＲＳＳＩの差に基づいて複数の固定局の各々から移動体までの距離差を求め、移動体の推定位置を、求めた距離差が生じる領域にさらに絞り込んでいる。

特許文献２では、移動体が仮定位置にあるときの計算上のＲＳＳＩと、実際に測定されたＲＳＳＩとの誤差に関する評価関数を極小化する仮定位置を、移動体の推定位置としている。評価関数を、固定局ごとに電波環境指標に応じて重み付けをしたＲＳＳＩの誤差の総和で表すことで、電波環境が悪い固定局におけるＲＳＳＩの誤差の重要度を下げて、移動体の推定位置の精度を向上している。

特開２０１２−２５５６７３号公報特開２０１２−１７３０７０号公報

しかしながら、従来の計算処理は、幾何学的に領域を絞り込む計算処理や、評価関数の極小点を探索する計算処理を含むため、演算負荷が高い。例えば、施設内での物品や人員の位置の管理など、省電力性が重視される場面では、低い演算負荷で、移動体の位置を推定することが求められる。

そこで、本発明は、低い演算負荷で移動体の位置を推定する位置推定装置及び位置推定方法を提供する。

上記目的を達成するために、本発明の一態様に係る位置推定装置は、互いに異なる既知の位置に設置され、移動体から発せられる電波の受信強度を測定する複数の受信器と、前記複数の受信器のうちの１つの受信器である対象受信器で測定された受信強度に基づき、前記移動体の推定位置を、前記対象受信器を中心とし前記受信強度に基づく距離を半径とする存在円に近づくように更新する処理を、前記複数の受信器の各々を対象受信器として逐次行う計算器と、を備える。

この構成によれば、単純な計算処理により、移動体の推定位置を、対象受信器を中心とする存在円に近づけることができる。当該処理を、複数の受信器の各々を対象受信器として逐次行うことで、移動体の推定位置は、複数の受信器の各々を中心とする存在円の重複領域に近づき、移動体の推定位置が特定される。その結果、低い演算負荷で移動体の位置を推定する位置推定装置が得られる。

また、１つの受信器のＲＳＳＩを用いて移動体の推定位置を更新する処理を逐次に行うので、ある受信器でＲＳＳＩの欠測があっても、他の受信器のＲＳＳＩで処理を続行できる。その結果、電波環境が安定せず、欠測が頻繁に生じる環境への適用に優れた位置推定装置が得られる。

また、前記計算器は、前記移動体の推定位置を、前記対象受信器と前記移動体の現在の推定位置とを通る直線と前記存在円との交点に近づくように更新してもよい。

この構成によれば、移動体と対象受信器とを通る直線と存在円との交点を求める計算処理により、移動体の推定位置を、対象受信器を中心とする存在円に近づけることができる。

また、前記計算器は、前記移動体の推定位置を、前記移動体の現在の推定位置と前記交点とを両端とする線分の内分点に更新してもよい。

ＲＳＳＩが、何らかの要因で大きくなると、ＲＳＳＩに基づく距離が小さくなり、隣接する受信器のそれぞれを中心とする存在円が離れることがある。その場合、移動体の推定位置は更新のたびに存在円間を行き来するが、上述の構成によれば、移動体の推定位置の振動の幅が縮小されるので、安定した推定位置が得られる。

また、前記計算器は、前記移動体の現在の推定位置が、前記存在円の外にある場合のみ、前記移動体の推定位置を更新してもよい。

ＲＳＳＩが、障害物やマルチパスなどによって減衰すると、存在円が著しく大きくなることがある。その場合でも、上述の構成によれば、移動体の推定位置が誤った存在円に追従することが避けられるので、安定した推定位置が得られる。

また、本発明の一態様に係る位置推定方法は、移動体から発せられる電波の受信強度を、互いに異なる既知の位置に設置された受信器で測定し、前記複数の受信器のうちの１つの受信器である対象受信器で測定された受信強度に基づき、前記移動体の推定位置を、前記対象受信器を中心とし前記受信強度に基づく距離を半径とする存在円に近づくように更新する処理を、前記複数の受信器の各々を対象受信器として逐次行うものである。

この構成によれば、単純な計算処理により、移動体の推定位置を、対象受信器を中心とする存在円に近づけることができる。当該処理を、複数の受信器の各々を対象受信器として逐次行うことで、移動体の推定位置は、複数の受信器の各々を中心とする存在円の重複領域に近づき、移動体の推定位置が特定される。その結果、移動体の位置を、ＲＳＳＩに基づき、演算負荷が低い計算処理で推定する位置推定方法が得られる。

また、１つの受信器のＲＳＳＩを用いて移動体の推定位置を更新する処理を逐次に行うので、ある受信器でＲＳＳＩの欠測があっても、他の受信器のＲＳＳＩで処理を続行できる。その結果、電波障害への耐性に優れた位置推定方法が得られる。

本発明によれば、低い演算負荷で移動体の位置を推定する位置推定装置及び位置推定方法が得られる。

図１は、３辺測量の基本的な考え方を説明する図である。図２は、位置推定装置が設置される施設の一例を示す概念図である。図３は、実施の形態１に係る位置推定装置の機能的な構成の一例を示すブロック図である。図４は、実施の形態１に係る位置推定装置の動作の一例を示すフローチャートである。図５は、ＲＳＳＩと距離との対応情報の一例を示すグラフである。図６は、実施の形態１に係る推定位置の１回の更新処理の一例を示す図である。図７Ａは、実施の形態１に係る推定位置の逐次の更新処理の一例を示す図である。図７Ｂは、実施の形態１に係る推定位置の逐次の更新処理の一例を示す図である。図７Ｃは、実施の形態１に係る推定位置の逐次の更新処理の一例を示す図である。図８は、実施の形態２の比較例に係る推定位置の逐次の更新処理の一例を示す図である。図９は、実施の形態２に係る推定位置の逐次の更新処理の一例を示す図である。

以下、本発明に係る実施の形態について、図面を用いて詳細に説明する。なお、以下で説明する実施の形態は、いずれも包括的又は具体的な例を示すものである。以下の実施の形態で示される数値、形状、材料、構成要素、構成要素の配置および接続形態、ステップ、ステップの順序などは、一例であり、本発明を限定する主旨ではない。以下の実施の形態における構成要素のうち、独立請求項に記載されていない構成要素については、任意の構成要素として説明される。また、図面に示される構成要素の大きさ又は大きさの比は、必ずしも厳密ではない。

（実施の形態１）
実施の形態１に係る位置推定装置は、互いに異なる既知の位置に設置された複数の受信器で移動体から発せられる電波の受信強度（以下ではＲＳＳＩと表記する）を測定し、測定されたＲＳＳＩに基づいて当該移動体の位置を推定する装置である。

図２は、位置推定装置が設置される施設の一例を示す概念図である。図２に示されるように、施設内において位置を検知したい移動体２０に、ビーコンを送出する発信器が取り付けられる。また、施設内のあらかじめ定められた位置に、位置推定装置を構成する固定局１００ａ〜１００ｆ、及びサーバ２００が設置される。

固定局１００ａ〜１００ｆ、及びサーバ２００は、図示していない通信ネットワークで互いに通信可能に接続されている。固定局１００ａ〜１００ｆの各々は、移動体２０から発せられたビーコンのＲＳＳＩを測定する。そして、サーバ２００は、当該通信ネットワークを介して、複数の固定局で測定されたＲＳＳＩを表すデータを取得し、当該データで表されるＲＳＳＩに基づいて移動体２０の位置を推定する。

図３は、実施の形態１に係る位置推定装置の機能的な構成の一例を示すブロック図である。図３では、簡明のため、位置推定装置１０において、固定局１００ａ、１００ｂ、１００ｃ、及びサーバ２００のみを示し、また位置推定装置１０とともに、移動体２０及び通信ネットワーク３０を示している。

移動体２０には、ビーコン２２を送出する発信器２１が取り付けられる。

発信器２１は、移動体２０を識別する識別情報を含む無線信号であるビーコン２２を、所定の送信強度で周期的に送出する。発信器２１は、例えば、０．１秒〜１秒おきに、ビーコン２２を送出してもよい。発信器２１は、一例として、ＲＦＩＤ（ＲａｄｉｏＦｒｅｑｕｅｎｃｙＩｄｅｎｔｉｆｉｒｅ）で用いられるアクティブＲＦタグであってもよい。また、Ｚｉｇｂｅｅ（登録商標）やＢｌｕｅｔｏｏｔｈ（登録商標）ＬｏｗＥｎｅｒｇｙといった、省電力性に優れた近距離無線通信規格に従ってビーコン２２を送出する無線装置であってもよい。

固定局１００ａ、１００ｂ、１００ｃは、互いに同一の構成を有するため、以下では、固定局１００ａについてのみ説明する。固定局１００ｂ及び１００ｃについては、以下で参照する符号の末尾に付した英字ａを、それぞれｂ及びｃと読み替える。

固定局１００ａは、受信器１１０ａ、通信器１２０ａ、及び計算器１３０ａを有する。

受信器１１０ａは、発信器２１と互換の無線通信規格に従って動作する無線装置であり、発信器２１から周期的に送出されるビーコン２２を受信し、受信のつど、ビーコン２２のＲＳＳＩを測定する。

通信器１２０ａは、固定局１００ａと、固定局１００ｂ、１００ｃ及びサーバ２００とを、通信ネットワーク３０を介して通信可能に接続する通信装置である。通信器１２０ａは、受信器１１０ａで測定されたビーコン２２のＲＳＳＩを、通信ネットワーク３０を介してサーバ２００へ通知する。通信ネットワーク３０は、有線及び無線の何れのネットワークであってもよく、通信器１２０ａには、通信ネットワーク３０に適した通信装置が用いられる。

通信器１２０ａは、一例として、有線ＬＡＮ（ＬｏｃａｌＡｒｅａＮｅｔｗｏｒｋ）に接続するネットワークアダプタであってもよい。また、Ｚｉｇｂｅｅ（登録商標）やＢｌｕｅｔｏｏｔｈ（登録商標）ＬｏｗＥｎｅｒｇｙといった、省電力性に優れた近距離無線通信規格に従って無線メッシュネットワークを構成する無線装置であってもよい。通信器１２０ａが、ビーコン２２用の無線通信規格と同一の無線通信規格に従って無線通信を行う場合、通信器１２０ａと受信器１１０ａとは、その一部又は全部を兼用してもよい。

計算器１３０ａは、固定局１００ａの動作を制御するコントローラである。

計算器１３０ａは、一例として、プロセッサ、メモリ、入出力ポートなどを有するワンチップマイコンであってもよい。計算器１３０ａは、固定局１００ａの動作を、前記メモリに記録されているプログラムを前記プロセッサが実行することにより果たされるソフトウェア機能によって制御してもよい。

サーバ２００は、通信器２２０及び計算器２３０を有する。

通信器２２０は、サーバ２００と固定局１００ａ、１００ｂ、１００ｃとを、通信ネットワーク３０を介して通信可能に接続する通信装置である。

計算器２３０は、受信器１１０ａ、１１０ｂ、１１０ｃで測定されたビーコン２２のＲＳＳＩを、通信器２２０を介して取得し、取得したＲＳＳＩに基づいて、移動体２０の位置を推定する。

計算器２３０は、一例として、図示していないプロセッサ、メモリなどを、バスで接続してなる汎用のコンピュータ装置であってもよい。計算器２３０は、ビーコン２２のＲＳＳＩの取得及び移動体２０の位置の推定を、前記メモリに記録されているプログラムを前記プロセッサが実行することにより果たされるソフトウェア機能によって行ってもよい。

次に、上記のように構成される位置推定装置１０の動作について説明する。

図４は、位置推定装置１０の動作の一例を示すフローチャートである。図４は、移動体２０について位置推定を行う処理の一例であり、例えば、移動体２０が位置検出エリアに進入し、移動体２０からのビーコンが最初に受信されたときに起動される。図４の処理は、移動体２０を含む複数の移動体の各々について並行して行われてもよい。

サーバ２００は、移動体２０の推定位置を初期位置に設定する（Ｓ１０１）。初期位置は任意であり、例えば、固定局１００ａ、１００ｂ、１００ｃの何れからも所定距離以上離れた地点であってもよい。

固定局１００ａ、１００ｂ、１００ｃのそれぞれが、ビーコン２２のＲＳＳＩを測定し、測定されたＲＳＳＩを表すデータをサーバ２００へ通知する（Ｓ１０２）。

サーバ２００は、ＲＳＳＩを表すデータを受信すると（Ｓ１０３でＹＥＳ）、受信されたデータに基づいて、次の処理を行う。

受信されたデータで表されるＲＳＳＩに基づく距離、つまり、データを受信した固定局から移動体２０までの距離を算出する（Ｓ１０４）。サーバ２００は、例えば、位置推定装置１０の運用環境におけるＲＳＳＩと距離との関係を表す対応情報を、数式や数表の態様で予め保持しておき、当該対応情報を参照してＲＳＳＩを距離に変換してもよい。対応情報は、運用環境での事前の実測値をもとに決定されてもよい。

図５は、対応情報の一例を示すグラフである。図５では、横軸を固定局から移動体までの距離とし、縦軸を固定局で測定されるビーコンのＲＳＳＩとして、対応情報を曲線で表し、事前の実測値をドットで表している。対応情報は、ＲＳＳＩが従う物理式を、実測値の最大値に当てはめて決定されている。実測値の中には、例えばマルチパスなどの影響のために、著しく小さい実測値がある。そのため、物理式を実測値の最大値に当てはめることで、運用環境での本来のＲＳＳＩと距離との関係を表す対応情報が得られる。図５の対応情報の例によれば、例えば、ＲＳＳＩが−６０ｄＢｍと測定されたとき、移動体までの距離は４ｍと算出される。

再び図４を参照して、サーバ２００は、ＲＳＳＩを測定した固定局（より厳密には対象受信器）の位置と当該ＲＳＳＩから算出した距離とを用いて、当該固定局と現在の推定位置とを通る直線と存在円との交点（以下では、目標点とも言う）を算出し（Ｓ１０５）、移動体２０の推定位置を、算出した交点に近づくように更新する（Ｓ１０６）。

サーバ２００は、移動体２０が位置検出エリア内にいる間（Ｓ１０７でＹＥＳ）、固定局１００ａ、１００ｂ、１００ｃの何れか１つからＲＳＳＩが取得されるたびに（Ｓ１０３でＹＥＳ）移動体２０の推定位置の更新処理（Ｓ１０４〜Ｓ１０６）を、逐次に行う。

図６は、１つの固定局から受信されたＲＳＳＩに基づいて行われる、推定位置の１回の更新処理の一例を示す図である。図６において、固定局の位置を座標値（ｘ_ＢＳ，ｙ_ＢＳ）で表し、移動体の現在の推定位置Ｐ０及び更新の目標点Ｐ１を、座標値（ｘ_Ｐ０，ｙ_Ｐ０）、（ｘ_Ｐ１，ｙ_Ｐ１）で、それぞれ表している。図６での現在の推定位置Ｐ０は、ステップＳ１０１で設定した初期位置、又は逐次の処理における都度の推定位置に対応する。

サーバ２００は、ＲＳＳＩに基づく距離ｄを、例えば、前述した対応情報（図５）を参照して、算出する。

サーバ２００は、固定局（対象受信器）と移動体２０の現在の推定位置Ｐ０とを通る直線Ｌ上にあって、固定局からＲＳＳＩに基づく距離ｄ離れた目標点Ｐ１を算出する。目標点Ｐ１の座標値（ｘ_Ｐ１，ｙ_Ｐ１）は、具体的には、固定局から現在の推定位置Ｐ０までの距離Ｄを用いて、（（ｄ／Ｄ）ｘ_ＢＳ＋（１−ｄ／Ｄ）ｘ_Ｐ０，（ｄ／Ｄ）ｙ_ＢＳ＋（１−ｄ／Ｄ）ｙ_Ｐ０）により算出される。

サーバ２００は、移動体２０の推定位置を、算出された目標点Ｐ１に更新する。

目標点Ｐ１は、直線Ｌと固定局を中心とする存在円との交点であり、言い換えれば、固定局を中心とする存在円上における現在の推定位置Ｐ０までの距離が最短の点（最近点）である。つまり、移動体２０の推定位置は、存在円上の最近点に更新される。

このようにして、移動体２０の推定位置は、実質的に固定局と現在の推定位置Ｐ０とを両端とする線分の内分点を求めるだけの、演算負荷が低い計算処理によって更新される。

なお、図６では、固定局から移動体２０の現在の推定位置Ｐ０までの距離が、固定局から目標点Ｐ１までの距離より長い場合を示している。移動体２０の推定位置の更新は、このような場合、つまり、現在の推定位置Ｐ０が存在円の外にある場合にのみ行うこととし、現在の推定位置Ｐ０が当該存在円の上又は内にある場合、推定位置の更新を禁止してもよい。

現在の推定位置が存在円の外にある場合のみ推定位置を更新することで、例えば、障害物やマルチパスなどによってＲＳＳＩが減衰して著しく大きい誤った存在円が設定された場合に、推定位置が当該誤った存在円上の目標点に更新されることを回避できる。これにより、安定した推定位置を得ることができる。

移動体２０の推定位置の逐次の更新処理について説明を続ける。

図７Ａ、図７Ｂ、図７Ｃは、固定局ａ、固定局ｂ、固定局ｃから通知されたＲＳＳＩに基づく逐次の更新処理の一例を示している。固定局ａ、固定局ｂ、固定局ｃは、限定はされないが、例えば、図３の固定局１００ａ、１００ｂ、１００ｃにそれぞれ対応してもよい。なお、図７Ａ、図７Ｂ、図７Ｃでは、移動体の推定位置が、初期位置に依らず存在円の重複領域（斜線部分）に収束することを説明するため、互いに異なる推定位置Ｐ０、Ｑ０、Ｒ０の各々から逐次処理を開始した場合の例を一度に示している。

図７Ａでは、固定局ａのＲＳＳＩに基づき、現在の推定位置Ｐ０、Ｑ０、Ｒ０に対し、目標点Ｐ１、Ｑ１、Ｒ１がそれぞれ算出される。推定位置Ｐ０、Ｑ０、Ｒ０は、算出された目標点Ｐ１、Ｑ１、Ｒ１にそれぞれ更新される。

図７Ｂでは、固定局ｂのＲＳＳＩに基づき、現在の推定位置Ｐ１、Ｑ１、Ｒ１に対し、目標点Ｐ２、Ｑ２、Ｒ２’がそれぞれ算出される。ここで、推定位置Ｒ１は、既に、固定局ｂを中心とする存在円の内部にあり、固定局ｂから現在の推定位置Ｒ１までの距離は、固定局ｂから目標点Ｒ２’までの距離より短い。そのため、推定位置Ｐ１、Ｑ１は、算出された目標点Ｐ２、Ｑ２にそれぞれ更新されるが、推定位置Ｒ１は更新されず、推定位置Ｒ１がそのまま推定位置Ｒ２（＝Ｒ１）となる。

図７Ｃでは、固定局ｃのＲＳＳＩに基づき、現在の推定位置Ｐ２、Ｑ２、Ｒ２に対し、目標点Ｐ３’、Ｑ３、Ｒ３がそれぞれ算出される。ここで、推定位置Ｐ２は、既に、固定局ｃを中心とする存在円の内部にあり、固定局ｃから現在の推定位置Ｐ２までの距離は、固定局ｃから目標点Ｐ３’までの距離より短い。そのため、推定位置Ｑ２、Ｒ２は、算出された目標点Ｑ３、Ｒ３にそれぞれ更新されるが、推定位置Ｐ２は更新されず、推定位置Ｐ２がそのまま推定位置Ｐ３（＝Ｐ２）となる。

図７Ａ、図７Ｂ、図７Ｃから分かるように、移動体の推定位置が、最初、Ｐ０、Ｑ０、Ｒ０のどこにあっても、数回の更新処理を逐次に行うことで、移動体の推定位置は、固定局ａ、固定局ｂ、固定局ｃの各々を中心とする存在円の重複領域の辺又は内部に更新される。

各回の更新処理は、上述したように、実質的に固定局と現在の推定位置とを両端とする線分の内分点を求めることで行われ、従来の、幾何学的に領域を絞り込む計算処理や、評価関数の極小点を探索する計算処理を含まない。

以上説明した位置推定装置によれば、演算負荷が低い計算処理で移動体の位置を推定する位置推定装置が得られる。

また、１つの受信器のＲＳＳＩを用いて移動体の推定位置を更新する処理を逐次に行うので、３辺測量と異なり、推定位置を更新する際に、３つ以上の受信器でのＲＳＳＩが揃うのを待つ必要がない。これにより、ある受信器でＲＳＳＩの欠測があっても、他の受信器のＲＳＳＩで処理を続行できる。

その結果、電波環境が安定せず頻繁に欠測が生じる環境での利用に優れた位置推定装置が得られる。当該位置推定装置は、例えば、ビーコンやＲＳＳＩを表すデータの送信に、干渉の多いＩＳＭ（ＩｎｄｕｓｔｒｙＳｃｉｅｎｃｅＭｅｄｉｃａｌ）バンドを使用する場合に、有効である。

また、位置検出エリアの端部などで、移動体の周囲に１つ又は２つの受信器しか存在しない状況にも適用できる。

（実施の形態２）
実施の形態１では、存在円上に目標点を設定し、推定位置を当該目標点に更新した。この構成によれば、ＲＳＳＩが何らかの要因で大きくなり、隣接する固定局のそれぞれを中心とする存在円が小さくなって互いに離れると、推定位置は更新のたびに存在円間を行き来することになる。

図８は、実施の形態２の比較例に係る推定位置の逐次の更新処理の一例を示す図である。

図８では、移動体の推定位置を、推定位置Ｓ０から開始して、固定局ａのＲＳＳＩと固定局ｂのＲＳＳＩとを交互に用いて更新している。推定位置は、実施の形態１で説明した目標点（存在円上における現在の推定位置からの最近点）に更新される。

図８に見られるように、推定位置Ｓ１〜Ｓ５は、更新のたびに、固定局ａ及び固定局ｂをそれぞれ中心とする存在円上を行き来し、安定した推定位置が得られない。

そこで、移動体の推定位置を、現在の推定位置と目標点とを両端とする線分の内分点に更新する。

図９は、実施の形態２に係る推定位置の逐次の更新処理の一例を示す図である。

図９では、図８と比べて、推定位置を、現在の推定位置と目標点（破線円で示す）との内分点の一例である中点に更新する点で相違する。初回の更新では、現在の推定位置Ｓ０に対する目標点Ｓ１が算出され、推定位置は、推定位置Ｓ０と目標点Ｓ１との中点（つまり、１：１での内分点）である推定位置Ｔ１に更新される。詳細な符号は省略しているが、２回目以降も、推定位置は同様に更新される。なお、内分の比率は、１：１には限られず、推定位置の収束速度と振動の抑制効果とに応じて、適宜選択されればよい。

図９に見られるように、推定位置を、現在の推定位置と目標点との内分点（一例として中点）に更新することで、推定位置Ｔ１〜Ｔ５の振動が抑制され、より安定した推定位置が得られる。

以上、本発明の実施の形態に係る位置推定装置及び位置推定方法について説明したが、本発明は、個々の実施の形態には限定されない。本発明の趣旨を逸脱しない限り、当業者が思いつく各種変形を本実施の形態に施したものや、異なる実施の形態における構成要素を組み合わせて構築される形態も、本発明の一つ又は複数の態様の範囲内に含まれてもよい。

本発明は、例えば、各種施設における物品及び人員の位置の管理など、移動体の位置推定に広く利用できる。

１０位置推定装置
２０移動体
２１発信器
２２ビーコン
３０通信ネットワーク
１００ａ〜１００ｆ固定局
１１０ａ〜１１０ｃ受信器
１２０ａ〜１２０ｃ通信器
１３０ａ〜１３０ｃ計算器
２００サーバ
２２０通信器
２３０計算器

Claims

互いに異なる既知の位置に設置され、移動体から発せられる電波の受信強度を測定する複数の受信器と、
前記複数の受信器のうちの１つの受信器である対象受信器で測定された受信強度に基づき、前記移動体の推定位置を、前記対象受信器を中心とし前記受信強度に基づく距離を半径とする存在円に近づくように更新する処理を、前記複数の受信器の各々を対象受信器として逐次行う計算器と、
を備える位置推定装置。
前記計算器は、前記移動体の推定位置を、前記対象受信器と前記移動体の現在の推定位置とを通る直線と前記存在円との交点に近づくように更新する、
請求項１に記載の位置推定装置。
前記計算器は、前記移動体の推定位置を、前記移動体の現在の推定位置と前記交点とを両端とする線分の内分点に更新する、
請求項２に記載の位置推定装置。
前記計算器は、前記移動体の現在の推定位置が、前記存在円の外にある場合のみ、前記移動体の推定位置を更新する、
請求項１から３の何れか１項に記載の位置推定装置。
移動体から発せられる電波の受信強度を、互いに異なる既知の位置に設置された受信器で測定し、
前記複数の受信器のうちの１つの受信器である対象受信器で測定された受信強度に基づき、前記移動体の推定位置を、前記対象受信器を中心とし前記受信強度に基づく距離を半径とする存在円に近づくように更新する処理を、前記複数の受信器の各々を対象受信器として逐次行う、
位置推定方法。