JP5871536B2 - 位置特定装置、位置特定方法、及びプログラム - Google Patents

Description

本発明は、自装置が存在する位置を特定する位置特定装置、位置特定方法、及びプログラムに関する。

近年、車両の位置に基づいて、当該車両に対して情報提供、警告、介入制御を行うサービスが注目されている。車両の位置は、カーナビゲーションシステムなどの位置特定装置が、ＧＰＳ（Ｇｌｏｂａｌ Ｐｏｓｉｔｉｏｎｉｎｇ Ｓｙｓｔｅｍ）や自律航法に基づいて特定する。また、車両位置の精度を高めるため、路側に設けられたビーコンから電波や光などの搬送波に乗った信号を受信し、通信が確立した位置をビーコンの位置に補正することで車両位置の補正を行う方法が用いられている（例えば、特許文献１を参照）。

特開２００９−０２６０５６号公報

しかしながらビーコンは、位置特定装置と確実に通信を行うため、所定の範囲（例えば、進行方向に１０メートル幅の範囲）に対して搬送波を照射する。そのため、位置特定装置がビーコンから信号を受信した位置に基づいて推定した位置情報には、搬送波の照射範囲の大きさに誤差が生じることとなる。

本発明は、上記の問題に鑑みてなされたものであり、ビーコンによる搬送波の照射範囲による誤差を低減して自装置が存在する位置を特定する位置特定装置、位置特定方法、及びプログラムを提供することを課題とする。

本発明は上記の課題を解決するためになされたものであり、自装置の位置を推定する位置推定部と、信号を乗せた搬送波を射出するビーコンから受信した信号に基づいて、当該ビーコンが設置された位置または当該ビーコンによる搬送波の照射範囲内において電波強度が最も強い位置であるビーコン位置を取得するビーコン位置取得部と、ビーコンによる搬送波の照射範囲が狭いほど大きい値を示す重み値を、前記ビーコン位置取得部が取得したビーコン位置の重みとして、前記位置推定部が推定した位置である推定位置と前記ビーコン位置との加重平均が示す位置を算出し、当該位置を自装置の位置として特定する位置特定部とを備えることを特徴とする。

また、本発明においては、前記位置特定部は、前記位置推定部による位置推定の誤差範囲が狭いほど大きい値を示す重み値を、前記推定位置の重みとして、前記推定位置と前記ビーコン位置との加重平均が示す位置を算出することが好ましい。

また、本発明においては、前記ビーコン位置は、所定の直交座標系における前記ビーコンによる搬送波の照射範囲内の位置を示す行列であり、前記推定位置は、前記直交座標系において自装置が存在すると推定される位置を示す行列であり、前記ビーコン位置の重みは、前記直交座標系において前記位置推定部による位置推定の誤差範囲の分散を示す分散共分散行列であり、前記推定位置の重みは、前記直交座標系においてビーコンからの信号を正常に受信できる位置の分散を示す分散共分散行列であることが好ましい。

また、本発明においては、前記ビーコン位置の重みは、自装置が設置された高さが高いほど小さい値を示すことが好ましい。

また、本発明においては、前記位置推定部が推定した推定位置に基づいて、自装置が存在する道路を特定する道路特定部と、前記道路特定部が特定した道路に対応するビーコン位置の重みを取得するビーコン重み取得部とを備え、前記位置特定部は、前記ビーコン重み取得部が取得した重みを用いて自装置の位置として特定することが好ましい。

また、本発明においては、前記ビーコン位置取得部は、正常に信号の受信を完了したときに、当該信号の搬送波の強度と、前記ビーコン位置と搬送波の強度との関係とに基づいてビーコン位置を推定することが好ましい。

また、本発明においては、前記ビーコンからの搬送波の強度を、当該搬送波を受信した位置に関連付けて搬送波強度記憶部に遂次記録する搬送波強度記録部を備え、前記ビーコン位置取得部は、前記搬送波強度記憶部が記憶する搬送波の強度の最大値に関連付けられた位置を、道路の延在方向におけるビーコン位置と推定することが好ましい。

また、本発明においては、前記ビーコン位置取得部は、前記搬送波強度記憶部が記憶する搬送波の強度の最大値と、道路の延在方向に直交する方向におけるビーコン位置と搬送波の強度関係とに基づいて、道路の延在方向に直交する方向におけるビーコン位置を推定することが好ましい。

また、本発明は、自装置が存在する位置を特定する位置特定装置を用いた位置特定方法であって、位置推定部は、自装置の位置を推定し、ビーコン位置取得部は、信号を乗せた搬送波を射出するビーコンから受信した信号に基づいて、当該ビーコンが設置された位置または当該ビーコンによる搬送波の照射範囲内において電波強度が最も強い位置であるビーコン位置を取得し、位置特定部は、ビーコンによる搬送波の照射範囲が狭いほど大きい値を示す重み値を、前記ビーコン位置取得部が取得したビーコン位置の重みとして、前記位置推定部が推定した位置である推定位置と前記ビーコン位置との加重平均が示す位置を算出し、当該位置を自装置の位置として特定することを特徴とする。

また、本発明は、自装置が存在する位置を特定する位置特定装置を、自装置の位置を推定する位置推定部、信号を乗せた搬送波を射出するビーコンから受信した信号に基づいて、当該ビーコンが設置された位置または当該ビーコンによる搬送波の照射範囲内において電波強度が最も強い位置であるビーコン位置を取得するビーコン位置取得部、ビーコンによる搬送波の照射範囲が狭いほど大きい値を示す重み値を、前記ビーコン位置取得部が取得したビーコン位置の重みとして、前記位置推定部が推定した位置である推定位置と前記ビーコン位置との加重平均が示す位置を算出し、当該位置を自装置の位置として特定する位置特定部として機能させるためのプログラムである。

本発明によれば、位置特定部は、推定位置とビーコン位置との加重平均が示す位置を自装置の位置として算出する。これにより、ビーコンによる搬送波の照射範囲による誤差を低減して自装置が存在する位置を特定することができる。

本発明の第１の実施形態による位置特定装置の構成を示す概略ブロック図である。 本発明の第１の実施形態による車両位置の特定方法を示す図である。 本発明の第１の実施形態による位置特定装置の動作を示すフローチャートである。 本発明の第２の実施形態によるビーコンが記憶するビーコン誤差の例を示す図である。 本発明の第２の実施形態による位置特定装置の構成を示す概略ブロック図である。 ビーコンが設置された交差点の状況の例を示す図である。 本発明の第３の実施形態によるビーコンが記憶するビーコン誤差の例を示す図である。 本発明の第３の実施形態による位置特定装置の構成を示す概略ブロック図である。 ビーコン位置が路側にある場合の走行位置と搬送波の強度との関係を示す図である。

《第１の実施形態》
以下、図面を参照しながら本発明の第１の実施形態について詳しく説明する。
図１は、本発明の第１の実施形態による位置特定装置の構成を示す概略ブロック図である。
位置特定装置は、車両に搭載され、自装置が存在する位置を特定する装置であり、位置推定部１、位置記憶部２、推定誤差算出部３、ビーコン信号受信部４、ビーコン位置取得部５、ビーコン誤差取得部６、位置特定部７、位置出力部８を備える。

位置推定部１は、ＧＰＳ及び自律航法に基づいて自装置の位置を推定し、推定した位置を示す推定位置Ｐ_ｃを、推定した時刻に関連付けて位置記憶部２に記録する。なお、推定位置Ｐ_ｃは、式（１）に示す行列である。

但し、ｘ_ｃ、ｙ_ｃは、それぞれ推定位置の緯度及び経度を示す値である。

位置記憶部２は、位置推定部１によって推定され、または位置特定部７によって特定された自装置の位置を示す位置情報を記憶する。
推定誤差算出部３は、位置記憶部２に蓄積された推定位置Ｐ_ｃの履歴、及び位置推定部１によるＧＰＳの推定精度に基づいて、位置推定部１による推定位置Ｐ_ｃの緯線方向・経線方向における誤差を示す分散共分散行列である推定誤差Ｒ_ｃを算出する。なお、推定誤差Ｒ_ｃは、式（２）に示す行列である。

但し、σ_ｃ＿ｘｘは、推定位置の緯線方向の分散を示す値である。また、σ_ｃ＿ｙｙは、推定位置の経線方向の分散を示す値である。σ_ｃ＿ｘｙは、推定位置の緯線方向と経線方向の共分散を示す値である。つまり、推定誤差Ｒ_ｃの各要素は、位置推定部１による位置推定の誤差範囲が広いほど大きい値を示す。

ビーコン信号受信部４は、路側に設けられたビーコンが出力する搬送波を捕捉し、当該搬送波から信号を抽出することで、信号を受信する。
ビーコン位置取得部５は、ビーコン信号受信部４が受信した信号から、ビーコンによる搬送波の照射範囲内の位置を示すビーコン位置Ｐ_ｂを読み出す。ここで、ビーコン位置Ｐ_ｂとしては、ビーコンが設置された位置や、照射範囲内において電波強度が最も強い位置などが設定される。なお、ビーコン位置Ｐ_ｂは、式（３）に示す行列である。

但し、ｘ_ｂ、ｙ_ｂは、それぞれビーコン位置の緯度及び経度を示す値である。

ビーコン誤差取得部６は、ビーコン信号受信部４が受信した信号から、ビーコン位置Ｐ_ｂを中心とした搬送波の照射範囲を示す分散共分散行列であるビーコン誤差Ｒ_ｂを読み出す。なお、ビーコン誤差Ｒ_ｂは、式（４）に示す行列である。

但し、σ_ｂ＿ｘｘは、ビーコンが照射する信号が受信される位置の緯線方向の分散を示す値である。また、σ_ｂ＿ｙｙは、ビーコンが照射する信号が受信される位置の経線方向の分散を示す値である。σ_ｂ＿ｘｙは、ビーコンが照射する信号が受信される位置の緯線方向と経線方向の共分散を示す値である。つまり、ビーコン誤差Ｒ_ｂの各要素は、ビーコンによる搬送波の照射範囲が広いほど大きい値を示す。

位置特定部７は、推定誤差算出部３が算出した推定誤差Ｒ_ｃを、ビーコン位置取得部５が取得したビーコン位置Ｐ_ｂの重みとし、ビーコン誤差取得部６が取得したビーコン誤差Ｒ_ｂを、位置記憶部２が記憶する推定位置Ｐ_ｃの重みとして、ビーコン位置Ｐ_ｂと推定位置Ｐ_ｃの加重平均を算出し、得られた位置Ｐを、自装置の位置と特定する。具体的には、位置特定部７は、式（５）を解くことで、自装置の位置Ｐを特定する。また、位置特定部７は、特定した位置Ｐを位置記憶部２が記憶する推定位置に上書きする。

但し、Ｘ^−１は、行列Ｘの逆行列を示す。
なお、本実施形態では、推定誤差算出部３が算出した推定誤差Ｒ_ｃを、ビーコン位置取得部５が取得したビーコン位置Ｐ_ｂの重みとし、ビーコン誤差取得部６が取得したビーコン誤差Ｒ_ｂを、位置記憶部２が記憶する推定位置Ｐ_ｃの重みとする。つまり、推定位置Ｐ_ｃの重みＲ_ｂは、位置推定の誤差範囲が狭いほどビーコン位置Ｐ_ｂの重みＲ_ｃに対して相対的に大きい値を示すこととなる。同様に、ビーコン位置Ｐ_ｂの重みＲ_ｃは、ビーコンの通信範囲が狭いほど推定位置Ｐ_ｃの重みＲ_ｂに対して相対的に大きい値を示すこととなる。

図２は、本発明の第１の実施形態による車両位置の特定方法を示す図である。
本実施形態では推定誤差Ｒ_ｃ及びビーコン誤差Ｒ_ｂは、２×２の分散共分散行列によって示される。したがって、これらの誤差を緯線及び経線を軸とする二次元平面に投射すると、誤差は図２に示すように楕円形に広がりを有する。

位置出力部８は、位置記憶部２が記憶する位置情報をディスプレイに出力する。

なお、本実施形態においてビーコンは、ビーコン位置Ｐ_ｂ及びビーコン誤差Ｒ_ｂを記憶する記憶部を備え、当該記憶部が記憶する情報を示す信号を搬送波に乗せて所定の照射範囲に出力する。なお、ビーコン誤差Ｒ_ｂは、ビーコンの設計時に予め決定しておく値であっても良いし、車両を通行させてビーコン誤差Ｒ_ｂを実測して求めた値であっても良い。

次に、本実施形態による位置特定装置の動作について説明する。
図３は、本発明の第１の実施形態による位置特定装置の動作を示すフローチャートである。
まず、位置特定装置が起動すると、位置推定部１は、ＧＰＳまたは自律航法にて自装置の位置すなわち自装置を搭載した車両の位置を推定する（ステップＳ１）。なお、位置推定部１は、位置記憶部２が記憶する過去の位置情報の履歴と、ＧＰＳまたは自律航法にて取得した位置とに基づいて現在の位置を推定するカルマンフィルタを備え、当該カルマンフィルタの出力値を、推定位置Ｐ_ｃとして出力する。次に、位置推定部１は、推定位置Ｐ_ｃを位置記憶部２に記録する（ステップＳ２）。

また、位置推定部１は、推定位置の推定誤差Ｒ_ｃを算出する（ステップＳ３）。具体的には、位置推定部１がステップＳ１においてＧＰＳによる位置推定を行った場合、位置推定に用いるＧＰＳ衛星の方向ベクトルに基づいてＤＯＰ（Ｄｉｌｕｔｉｏｎ Ｏｆ Ｐｒｅｃｉｓｉｏｎ）値を算出し、当該ＤＯＰ値に基づいて推定誤差Ｒ_ｃを算出する。他方、位置推定部１がステップＳ１において自律航法による位置推定を行った場合、位置推定部１のカルマンフィルタにおいて学習された誤差を推定誤差Ｒ_ｃとする。

次に、ビーコン信号受信部４は、ビーコンから信号を受信したか否かを判定する（ステップＳ４）。なお、ビーコン信号受信部４は、エラーなく信号の受信を完了したときに、ビーコンから信号を受信したと判定する。ビーコン信号受信部４が、ビーコンから信号を受信したと判定した場合（ステップＳ４：ＹＥＳ）、ビーコン位置取得部５は、ビーコン信号受信部４が受信した信号に含まれるビーコン位置Ｐ_ｂを示す情報を取得する（ステップＳ５）。また、ビーコン誤差取得部６は、ビーコン信号受信部４が受信した信号に含まれるビーコン誤差Ｒ_ｂを取得する（ステップＳ６）。

次に、位置特定部７は、推定位置Ｐ_ｃ、推定誤差Ｒ_ｃ、ビーコン位置Ｐ_ｂ、ビーコン誤差Ｒ_ｂを用いて上記式（５）を解くことで、車両位置Ｐを特定する（ステップＳ７）。式（５）によれば、これにより、誤差の大きさによって重みを動的に決定することができる。また、位置推定の誤差範囲が狭いほど（推定精度が高いほど）ビーコン位置Ｐ_ｂの重みＲ_ｃが小さくなるため、特定される車両位置Ｐは、推定位置Ｐ_ｃに近い位置となる。同様に、ビーコンの通信範囲が狭いほど推定位置Ｐ_ｃの重みＲ_ｂが小さくなるため、特定される車両位置Ｐは、ビーコン位置Ｐ_ｂに近い位置となる。
次に、位置特定部７は、特定した車両位置を、ステップＳ２で記録した推定位置に上書きして位置記憶部２に記録する（ステップＳ８）。

ステップＳ８で車両位置を上書きした場合、またはビーコン信号受信部４がステップＳ４でビーコンから信号を受信していないと判定した場合（ステップＳ４：ＮＯ）、位置出力部８は、位置記憶部２に最後に記録された車両位置をディスプレイに出力する（ステップＳ９）。
次に、位置特定装置は、利用者による操作や割り込み処理などにより、外部から処理の終了要求を入力したか否かを判定する（ステップＳ１０）。位置特定装置は、外部から終了要求を入力していないと判定した場合（ステップＳ１０：ＮＯ）、ステップＳ１に戻り、車両位置の推定を行う。他方、位置特定装置は、外部から終了要求を入力したと判定した場合（ステップＳ１０：ＹＥＳ）、処理を終了する。

このように、本実施形態によれば、ビーコンによる搬送波の照射範囲が狭いほど大きい値を示す重み値Ｒ_ｃをビーコン位置Ｐ_ｂの重みとして、推定位置Ｐ_ｃとビーコン位置Ｐ_ｂとの加重平均が示す位置を算出し、当該位置を自装置の位置として特定する。これにより、ビーコンによる搬送波の照射範囲が狭い場合、すなわちビーコン位置Ｐ_ｂが信頼できる場合にビーコン位置Ｐ_ｂに近い位置を車両位置Ｐと特定し、ビーコンによる搬送波の照射範囲が広い場合、すなわちビーコン位置Ｐ_ｂが信頼できない場合にビーコン位置Ｐ_ｂより推定位置Ｐ_ｃに近い位置を車両位置Ｐと特定する。これにより、ビーコンによる搬送波の照射範囲による誤差を低減して自装置が存在する位置を特定することができる。

また、本実施形態によれば、位置推定部１による位置推定の誤差範囲が狭いほど大きい値を示す重み値Ｒ_ｂを、推定位置Ｐ_ｃの重みとして、推定位置Ｐ_ｃとビーコン位置Ｐ_ｂとの加重平均が示す位置を算出する。これにより、位置推定の誤差が小さい場合、すなわち推定位置Ｐ_ｃが信頼できる場合に推定位置Ｐ_ｃに近い位置を車両位置Ｐと特定し、位置推定の誤差が大きい場合、すなわち推定位置Ｐ_ｃが信頼できない場合に推定位置Ｐ_ｃよりビーコン位置Ｐ_ｂに近い位置を車両位置と特定する。これにより、推定誤差の影響を加味して自装置が存在する位置を特定することができる。

また、本実施形態によれば、推定誤差Ｒ_ｃ、ビーコン誤差Ｒ_ｂは、それぞれ２×２の分散共分散行列によって表される。そして、当該行列を用いることで、緯度・経度で示される二次元の直交座標空間において、楕円形に広がる重みＲ_ｃ、Ｒ_ｂを用いて車両位置の特定を行うことができる。なお、図２に示すように緯線方向・経線方向に直交する軸を長軸・短軸とする場合に限られず、緯線方向及び経線方向に交差する方向に長軸・短軸とする場合も、分散共分散行列によって表現することができる。ビーコンによる搬送波の照射範囲の多くは、道路の延在方向に長軸を有する楕円形に近似することができる。他方、道路の延在方向は緯線方向または経線方向と一致するとは限らない。そのため、本実施形態のように重み値に行列を用いることで、ビーコンの搬送波の照射範囲の形状に合った重みを用いて車両位置の特定を行うことができる。

《第２の実施形態》
次に、図面を参照しながら本発明の第２の実施形態について詳しく説明する。
第２の実施形態は、第１の実施形態におけるビーコンから送出される信号に、車種毎のビーコン誤差Ｒ_ｂが含まれる形態である。

図４は、本発明の第２の実施形態によるビーコンが記憶するビーコン誤差の例を示す図である。
ビーコンは、ビーコン誤差Ｒ_ｂとして、乗用車のビーコン誤差Ｒ_ｂ ^ｖ、バスの乗用車のビーコン誤差Ｒ_ｂ ^ｂ、バイクのビーコン誤差Ｒ_ｂ ^ｍを記憶しており、それぞれのビーコン誤差Ｒ_ｂを含む信号を搬送波に乗せて送出する。
なお、ビーコンが記憶する乗用車のビーコン誤差Ｒ_ｂ ^ｖは、バスのビーコン誤差Ｒ_ｂ ^ｂと比べて大きい値になる。これは、通常、乗用車における位置特定装置の設置高さがバスにおける位置が特定装置の設置高さより低い位置にあるため、バスに設置された位置特定装置のほうが乗用車に設置された位置特定装置よりアンテナに近く、搬送波の照射範囲が小さいためである。
このように、ビーコンが記憶するビーコン誤差Ｒ_ｂは、位置特定装置が設置された高さが高いほど小さい値を示す。

図５は、本発明の第２の実施形態による位置特定装置の構成を示す概略ブロック図である。
第２の実施形態による位置特定装置は、第１の実施形態による位置特定装置にさらに車種情報取得部９を備え、ビーコン誤差取得部６の動作が異なるものである。
車種情報取得部９は、自装置が設置された車両の車種情報を車載器から取得する。

ビーコン誤差取得部６は、ビーコン信号受信部４が受信した信号に含まれるビーコン誤差Ｒ_ｂのうち、車種情報取得部９が取得した車種情報に関連付けられたものを取得する。これにより、位置特定部７は、自装置が設置された高さに応じたビーコン誤差Ｒ_ｂを用いることで、より精度よく車両位置の特定をすることができる。

《第３の実施形態》
次に、図面を参照しながら本発明の第３の実施形態について詳しく説明する。
第３の実施形態は、第１の実施形態におけるビーコンから送出される信号に、道路毎のビーコン誤差Ｒ_ｂが含まれる形態である。

図６は、ビーコンが設置された交差点の状況の例を示す図である。
ビーコンの設置場所の周囲の環境によって、ビーコンの搬送波照射範囲が異なる場合がある。図６に示す例は、道路１の延在方向に道路３が設けられ、また道路２の延在方向に道路４が設けられ、道路１、３と道路２、４とが交差する交差点の例である。ここで、図６に示す交差点では、道路１、３の幅が道路２、４の幅より広く、また道路２の両隣には空き地が広がり、また道路４の両隣にはビルが建っている。また、ビーコンは、ビーコン位置が交差点の中央になるように設けられている。

図６に示す例では、道路１、３は、道路２、４と比較して幅が広いため、道路１、３の道路幅方向の搬送波の照射範囲は、道路２、４の搬送波の照射範囲より広い。また、道路４の両隣はビルであるため、道路延在方向の搬送波の照射範囲は、両隣が空き地である道路２と比較して狭い。
このように、道路によって搬送波の広がりが異なるため、道路毎にビーコン誤差Ｒ_ｂを異ならせることが好ましい。

図７は、本発明の第３の実施形態によるビーコンが記憶するビーコン誤差の例を示す図である。
ビーコンは、ビーコン誤差Ｒ_ｂとして、道路毎のビーコン誤差（図６の例では、道路１のビーコン誤差Ｒ_ｂ ^１、道路２のビーコン誤差Ｒ_ｂ ^２、道路３のビーコン誤差Ｒ_ｂ ^３、道路４のビーコン誤差Ｒ_ｂ ^４）を記憶しており、それぞれのビーコン誤差Ｒ_ｂを含む信号を搬送波に乗せて送出する。

図８は、本発明の第３の実施形態による位置特定装置の構成を示す概略ブロック図である。
第３の実施形態による位置特定装置は、第１の実施形態による位置特定装置にさらに道路特定部１０を備え、ビーコン誤差取得部６の動作が異なるものである。
道路特定部１０は、位置記憶部２が記憶する車両位置に基づいて、現在車両が存在する道路を特定する。

ビーコン誤差取得部６は、ビーコン信号受信部４が受信した信号に含まれるビーコン誤差Ｒ_ｂのうち、道路特定部１０が特定した道路に関連付けられたものを取得する。これにより、位置特定部７は、自装置が存在する道路に関連付けられたビーコン誤差Ｒ_ｂを用いることで、より精度よく車両位置の特定をすることができる。

《第４の実施形態》
次に、本発明の第４の実施形態について詳しく説明する。
第４の実施形態は、第１の実施形態と異なる方法でビーコン位置Ｐ_ｂを特定する形態である。
第１の実施形態では、ビーコンから送出される信号にビーコン位置が含まれ、ビーコン位置取得部５が信号からビーコン位置を読み出すことで取得する場合を説明した。第４の実施形態では、ビーコンからの信号の受信時における搬送波の強度から、ビーコン位置を推定する形態について説明する。

信号の受信位置がビーコン位置から遠いほど、信号受信時の搬送波の強度は弱い。したがって、信号の受信位置と搬送波の強度、及び受信位置と強度の関係が分かれば、位置特定装置はビーコン位置を推定することができる。
第４の実施形態によるビーコンは、ビーコン位置に代えて、電波強度と受信位置からビーコン位置までの距離との関係を示す情報を記憶しており、当該情報を含む信号を搬送波に乗せて送出する。
第４の実施形態による位置特定装置のビーコン位置取得部５は、ビーコン信号受信部４が信号を受信したときの搬送波の強度と、受信した信号に含まれる情報を読み出す。次に、ビーコン位置取得部５は、読み出した情報において、信号を受信したときの搬送波の強度に関連付けられたビーコン位置までの距離を読み出す。そして、位置記憶部２が記憶する現在の推定位置の、道路延在方向（または車両進行方向）に読み出した距離を加算することで、ビーコン位置を算出する。

このように、本実施形態によれば、ビーコンからの信号受信時における搬送波の受信強度に基づいて、ビーコン位置を算出することができる。

《第５の実施形態》
次に、本発明の第５の実施形態について詳しく説明する。
第５の実施形態は、第１の実施形態、第４の実施形態と異なる方法でビーコン位置Ｐ_ｂを特定する形態である。
第１の実施形態では、ビーコンから送出される信号にビーコン位置が含まれ、ビーコン位置取得部５が信号からビーコン位置を読み出すことで取得する場合を説明した。また、第４の実施形態では、ビーコンからの信号の受信時における搬送波の強度から、ビーコン位置を推定する場合について説明した。第５の実施形態では、ビーコンからの搬送波の強度のピーク値に基づいてビーコン位置を推定する形態について説明する。

位置特定装置とビーコン位置とが近いほど、受信する搬送波の強度は強い。したがって、位置特定装置がビーコン位置を通過する際、位置特定装置が受信した搬送波の強度がピークとなる点が、ビーコン位置であると推定することができる。
第５の実施形態による位置特定装置のビーコン位置取得部５は、位置特定装置の推定位置と、当該推定位置においてビーコン信号受信部４が検知する搬送波の強度とを関連付けて遂次記憶する。次に、ビーコン位置取得部５は、ビーコン信号受信部４が検知する搬送波の強度がピークを過ぎたとき、ピークとなる強度に関連付けられた推定位置をビーコン位置として読み出す。

このように、本実施形態によれば、ビーコンからの信号受信時における搬送波の受信強度に基づいて、ビーコン位置を算出することができる。

《第６の実施形態》
次に、本発明の第６の実施形態について詳しく説明する。
第５の実施形態では、ビーコン位置を搬送波のピーク強度に基づいて決定する方法を説明した。しかしこの方法は、道路延在方向におけるビーコン位置を特定することができるが、道路幅方向におけるビーコン位置を特定することができない。そこで、ビーコン位置が道路の中央でなく、路側になるようにビーコンが設置されている場合、第６の実施形態で説明する方法を用いてビーコン位置を特定することで、道路延在方向及び道路幅方向におけるビーコン位置を特定する。

図９は、ビーコン位置が路側にある場合の走行位置と搬送波の強度との関係を示す図である。
信号の受信位置がビーコン位置から遠いほど、信号受信時の搬送波の強度は弱い。したがって、図９に示すように、搬送波の強度がピークになる点において、車両が道路幅方向においてビーコン位置に近い位置を走行している場合、ビーコン位置から遠い位置を走行している場合と比較して搬送波の受信強度が強くなる。つまり、搬送波のピーク強度及び道路幅方向のビーコン位置とピーク強度の関係が分かれば、位置特定装置はビーコン位置を推定することができる。

第６の実施形態によるビーコンは、ビーコン位置に代えて、搬送波のピーク強度と道路幅方向のビーコン位置との関係を示す情報を記憶しており、当該情報を含む信号を搬送波に乗せて送出する。
第６の実施形態による位置特定装置のビーコン位置取得部５は、ビーコン信号受信部４が検出した搬送波のピーク強度と、受信した信号に含まれる情報を読み出す。次に、ビーコン位置取得部５は、読み出した情報において、搬送波のピーク強度に関連付けられた、道路幅方向のビーコン位置を読み出す。
これにより、本実施形態によれば、ビーコンからの信号受信時における搬送波の受信強度に基づいて、道路延在方向、及び道路幅方向におけるビーコン位置を算出することができる。

以上、図面を参照してこの発明の一実施形態について詳しく説明してきたが、具体的な構成は上述のものに限られることはなく、この発明の要旨を逸脱しない範囲内において様々な設計変更等をすることが可能である。
例えば、上述した実施形態では、ビーコン位置Ｐ_ｂ及びビーコン誤差Ｒ_ｂを示す信号をビーコンが出力する場合について説明したが、これに限られず、位置特定装置が各ビーコンの識別情報に関連付けて当該ビーコンのビーコン位置Ｐ_ｂ及びビーコン誤差Ｒ_ｂを予め記憶しておくようにしても良い。

また、上述した実施形態では、指定誤差算出部が算出した推定誤差Ｒ_ｃと、ビーコン誤差取得部６が取得したビーコン誤差Ｒ_ｂとを用いて車両位置の推定を行う場合を説明したが、これに限られず、推定誤差Ｒ_ｃを固定値としても良い。

また、上述した実施形態では、推定誤差Ｒ_ｃをビーコン位置Ｐ_ｂの重みとして用い、ビーコン誤差Ｒ_ｂを推定位置Ｐ_ｃの重みとして用いる場合を説明したが、これに限られず、例えば、推定誤差Ｒ_ｃの逆数を推定位置Ｐ_ｃの重みとして用い、ビーコン誤差Ｒ_ｂの逆数をビーコン位置Ｐ_ｂの重みとして用いても良い。

また、上述した実施形態では、重み値Ｒ_ｂ、Ｒ_ｃとして行列を使う場合を説明したが、これに限られず重み値にスカラ値を用いても良い。
また、上述した実施形態では、重み値Ｒ_ｂ、Ｒ_ｃとして分散共分散行列を用いる場合を説明したが、これに限られず、例えばビーコン位置の標準偏差や範囲などの他の散布度を用いても良いし、受信位置からビーコン位置までの距離の平均値や中央値などの代表値を用いても良い。

上述の位置特定装置は内部に、コンピュータシステムを有している。そして、上述した各処理部の動作は、プログラムの形式でコンピュータ読み取り可能な記録媒体に記憶されており、このプログラムをコンピュータが読み出して実行することによって、上記処理が行われる。ここでコンピュータ読み取り可能な記録媒体とは、磁気ディスク、光磁気ディスク、ＣＤ−ＲＯＭ、ＤＶＤ−ＲＯＭ、半導体メモリ等をいう。また、このコンピュータプログラムを通信回線によってコンピュータに配信し、この配信を受けたコンピュータが当該プログラムを実行するようにしても良い。

また、上記プログラムは、前述した機能の一部を実現するためのものであっても良い。さらに、前述した機能をコンピュータシステムにすでに記録されているプログラムとの組み合わせで実現できるもの、いわゆる差分ファイル（差分プログラム）であっても良い。

１…位置推定部 ２…位置記憶部 ３…推定誤差算出部 ４…ビーコン信号受信部 ５…ビーコン位置取得部 ６…ビーコン誤差取得部 ７…位置特定部 ８…位置出力部 ９…車種情報取得部 １０…道路特定部

Claims (10)

1. 自装置の位置を推定する位置推定部と、
   信号を乗せた搬送波を射出するビーコンから受信した信号に基づいて、当該ビーコンが設置された位置または当該ビーコンによる搬送波の照射範囲内において電波強度が最も強い位置であるビーコン位置を取得するビーコン位置取得部と、
   ビーコンによる搬送波の照射範囲が狭いほど大きい値を示す重み値を、前記ビーコン位置取得部が取得したビーコン位置の重みとして、前記位置推定部が推定した位置である推定位置と前記ビーコン位置との加重平均が示す位置を算出し、当該位置を自装置の位置として特定する位置特定部と
   を備えることを特徴とする位置特定装置。
2. 前記位置特定部は、前記位置推定部による位置推定の誤差範囲が狭いほど大きい値を示す重み値を、前記推定位置の重みとして、前記推定位置と前記ビーコン位置との加重平均が示す位置を算出する
   ことを特徴とする請求項１に記載の位置特定装置。
3. 前記ビーコン位置は、所定の直交座標系における前記ビーコンによる搬送波の照射範囲内の位置を示す行列であり、
   前記推定位置は、前記直交座標系において自装置が存在すると推定される位置を示す行列であり、
   前記ビーコン位置の重みは、前記直交座標系において前記位置推定部による位置推定の誤差範囲の分散を示す分散共分散行列であり、
   前記推定位置の重みは、前記直交座標系においてビーコンからの信号を正常に受信できる位置の分散を示す分散共分散行列である
   ことを特徴とする請求項２に記載の位置特定装置。
4. 前記ビーコン位置の重みは、自装置が設置された高さが高いほど小さい値を示すことを特徴とする請求項２に記載の位置特定装置。
5. 前記位置推定部が推定した推定位置に基づいて、自装置が存在する道路を特定する道路特定部と、
   前記道路特定部が特定した道路に対応するビーコン位置の重みを取得するビーコン重み取得部と
   を備え、
   前記位置特定部は、前記ビーコン重み取得部が取得した重みを用いて自装置の位置として特定する
   ことを特徴とする請求項１から請求項４の何れか１項に記載の位置特定装置。
6. 前記ビーコン位置取得部は、正常に信号の受信を完了したときに、当該信号の搬送波の強度と、前記ビーコン位置と搬送波の強度との関係とに基づいてビーコン位置を推定することを特徴とする請求項１から請求項５の何れか１項に記載の位置特定装置。
7. 前記ビーコンからの搬送波の強度を、当該搬送波を受信した位置に関連付けて搬送波強度記憶部に遂次記録する搬送波強度記録部を備え、
   前記ビーコン位置取得部は、前記搬送波強度記憶部が記憶する搬送波の強度の最大値に関連付けられた位置を、道路の延在方向におけるビーコン位置と推定する
   ことを特徴とする請求項１から請求項５の何れか１項に記載の位置特定装置。
8. 前記ビーコン位置取得部は、前記搬送波強度記憶部が記憶する搬送波の強度の最大値と、道路の延在方向に直交する方向におけるビーコン位置と搬送波の強度関係とに基づいて、道路の延在方向に直交する方向におけるビーコン位置を推定する
   ことを特徴とする請求項７に記載の位置特定装置。
9. 自装置が存在する位置を特定する位置特定装置を用いた位置特定方法であって、
   位置推定部は、自装置の位置を推定し、
   ビーコン位置取得部は、信号を乗せた搬送波を射出するビーコンから受信した信号に基づいて、当該ビーコンが設置された位置または当該ビーコンによる搬送波の照射範囲内において電波強度が最も強い位置であるビーコン位置を取得し、
   位置特定部は、ビーコンによる搬送波の照射範囲が狭いほど大きい値を示す重み値を、前記ビーコン位置取得部が取得したビーコン位置の重みとして、前記位置推定部が推定した位置である推定位置と前記ビーコン位置との加重平均が示す位置を算出し、当該位置を自装置の位置として特定する
   ことを特徴とする位置特定方法。
10. 自装置が存在する位置を特定する位置特定装置を、
    自装置の位置を推定する位置推定部、
    信号を乗せた搬送波を射出するビーコンから受信した信号に基づいて、当該ビーコンが設置された位置または当該ビーコンによる搬送波の照射範囲内において電波強度が最も強い位置であるビーコン位置を取得するビーコン位置取得部、
    ビーコンによる搬送波の照射範囲が狭いほど大きい値を示す重み値を、前記ビーコン位置取得部が取得したビーコン位置の重みとして、前記位置推定部が推定した位置である推定位置と前記ビーコン位置との加重平均が示す位置を算出し、当該位置を自装置の位置として特定する位置特定部
    として機能させるためのプログラム。

Images