JP6014987B2 - 測位装置、測位方法及びプログラム - Google Patents
測位装置、測位方法及びプログラム Download PDFInfo
- Publication number
- JP6014987B2 JP6014987B2 JP2011218037A JP2011218037A JP6014987B2 JP 6014987 B2 JP6014987 B2 JP 6014987B2 JP 2011218037 A JP2011218037 A JP 2011218037A JP 2011218037 A JP2011218037 A JP 2011218037A JP 6014987 B2 JP6014987 B2 JP 6014987B2
- Authority
- JP
- Japan
- Prior art keywords
- positioning
- point
- position data
- correction
- movement
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Description
使用者によって所持される測位装置であって、測位衛星から送信された信号により当該装置本体の現在位置を測位し、その位置データを取得する第1測位手段と、当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位手段により測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位手段と、前記第1測位手段により取得された測位地点の位置データに基づいて、前記第2測位手段により取得された前記移動経路の各地点の位置データを補正する補正手段と、前記第1測位手段により取得された測位地点の位置データと、当該測位地点に対応する前記第2測位手段により取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する第1判定手段と、この第1判定手段により前記差異量が所定値よりも大きいと判定された場合に、前記第1測位手段により前記測位地点の測位後に新たに測定された新測位地点の位置データと当該新測位地点に対応する前記第2測位手段により取得された前記移動経路の第3地点の位置データとの差異量が所定値よりも大きいか否かを判定する第2判定手段と、この第2判定手段により前記差異量が所定値よりも大きくないと判定された場合に、前記補正手段に対し、前記移動経路の軌跡の形状を保持させるように前記移動経路の各地点の位置データを補正させる補正処理を実行させる制御手段と、を備えたことを特徴としている。
実施形態1の測位装置100は、ユーザに携帯所持され、GPS(全地球測位システム)による測位(GPS測位)と、自律航法用センサを用いた測位(自律航法測位)とを併用して、ユーザの移動軌跡を表わす一連の位置データを逐次記録していく装置である。
図1は、本発明を適用した実施形態1の測位装置100の概略構成を示すブロック図である。
図1に示すように、測位装置100は、装置の全体的な制御を行う中央制御部1と、GPS処理部2と、センサ部3と、自律航法制御処理部4と、データ記憶部5と、補正処理部6と、計時部7と、表示部8と、地図データベース9と、操作入力部10等を備えている。
RAMは、例えば、CPUにより実行される処理プログラム等を展開するためのプログラム格納領域や、入力データや上記処理プログラムが実行される際に生じる処理結果等を格納するデータ格納領域などを備える。
ROMは、コンピュータ読み取り可能なプログラムコードの形態で格納されたプログラム、具体的には、測位装置100で実行可能なシステムプログラム、当該システムプログラムで実行可能な各種処理プログラムや、これら各種処理プログラムを実行する際に使用されるデータ等を記憶する。例えば、ROMには、継続的な自律航法測位と間欠的なGPS測位とにより移動経路上の各地点の位置データを取得していく歩行測位処理のプログラムが記憶されている。
即ち、受信アンテナ2aは、受信手段として、地球低軌道に打ち上げられた複数のGPS衛星S(測位衛星;図1には一つのみ図示)Sから送信されるGPS信号(例えば、アルマナック(概略軌道情報)やエフェメリス(詳細軌道情報)など)を所定のタイミングで受信する。そして、受信アンテナ2aは、受信したGPS信号をGPS処理部2に出力する。
また、GPS処理部2は、動作制御部6により設定された所定の時間間隔毎に、当該装置本体の現在位置に係る位置データを逐次取得する(詳細後述)。
ここで、GPS処理部2は、受信アンテナ2aにより受信された信号に基づいて、当該装置本体の存する現在位置を測位し、その位置データを取得する第1測位手段を構成している。
3軸加速度センサ3bは、自律航法用センサであり、互いに直交する3軸方向の加速度をそれぞれ検出する。そして、3軸加速度センサ3bは、検出された各軸の検出信号を所定の周波数でサンプリングして、自律航法制御処理部4に出力する。
気圧センサ3cは、高低差を求めるために気圧を検出するセンサである。また、気圧センサ3cは、検出された気圧の検出信号を自律航法制御処理部4に出力する。
即ち、自律航法制御処理部4は、例えば、屋内等の受信アンテナ2aにより信号受信が行われない環境下にて、センサ部3の自律航法用センサを用いた自律航法測位を行う。具体的には、自律航法制御処理部4は、所定のサンプリング周期で3軸地磁気センサ3a及び3軸加速度センサ3bにより検出された検出データを取得して、これらの検出データから測位装置100の移動方向及び移動量を算出していく。例えば、自律航法制御処理部4は、3軸地磁気センサ3aの出力に現れる歩行時特有の出力変動パターンから移動方向を算出する。また、自律航法制御処理部4は、3軸加速度センサ3bの出力から測位装置100の上下動の認識処理を行い、この上下動から歩数を求めて歩幅データと乗算することで、歩行による移動量を算出する。また、自律航法制御処理部4は、これら移動方向と移動量の算出に加えて、気圧センサ3cの出力値の変化から高さ方向の移動量についても算出する。
さらに、自律航法制御処理部4は、検出データを取得する直前の当該装置本体の存する現在位置(測定済みの第1地点)の位置データに、算出された移動方向及び移動量からなる相対的なベクトルデータを加算することで、自律航法の測位結果である位置データを算出する。また、自律航法制御処理部4は、当該位置データを所定の時間間隔毎に連続して算出することで、当該装置本体の位置データを取得する。
また、移動履歴データ5bには、例えば、一連の位置データに付随して、位置データの取得順序を表わすインデックスナンバー「No.」と、位置データが取得されたときの時刻を表わす時刻データと、位置データが補正済みのものか否かを表わす補正フラグ等がそれぞれ登録されるようになっている。
即ち、補正処理部6は、自律航法制御処理部4によって算出されてデータ記憶部5に記憶されている移動履歴データ5bに基づいて、移動経路中の各地点の位置データに対して、間欠的に行われるGPS測位の結果に基づく補正演算を行う。
具体的には、補正処理部6は、第1補正部6aと、第2補正部6bと、補正制御部6cとを具備し、補正制御部6cの制御下にて、第1補正部6a及び第2補正部6bのうちの何れか一の補正処理部により、自律航法測位された移動経路中の各地点の位置データの補正演算を行う。
また、自律航法測位により算出された移動経路に係る一連の位置データは補正前データとしてデータ記憶部5に蓄積される。この補正前の一連の位置データに対応する軌跡T1を一点鎖線で表す(図5(a)参照)。
具体的には、補正制御部6cは、GPS測位による測位再開地点Bの位置と、自律航法測位による移動経路の終点B1の位置との差異を判定する判定部c1を具備し、当該判定部c1による判定結果に応じて、補正処理部6による自律航法測位により得られた位置データの補正処理の内容を変更させる制御を行う。
即ち、判定部c1は、GPS処理部2により測定済みの移動経路の始点Aから測位再開地点Bに向かう第1ベクトルと、始点Aから移動経路の終点B1に向かう第2ベクトルとをそれぞれ算出する。そして、判定部c1は、第1ベクトルと第2ベクトルの各々の大きさを算出して、これらの大きさの差(差異量)が第1判定値(所定値)よりも大きいか否かを判定する。ここで、第1判定値は、例えば、第1ベクトル及び第2ベクトルの大きさの何れか一方を基準として他方に対する差が所定の割合(例えば、20%程度)となるような値に設定されている。
また、判定部c1は、第1ベクトルと第2ベクトルとの方向のずれ量が第2判定値よりも大きいか否かを判定する。ここで、第2判定値は、例えば、第1ベクトルと第2ベクトルとの方向のずれが所定の角度(例えば、20°程度)となるような値に設定されている。
なお、第1判定値及び第2判定値として例示した値は、一例であってこれらに限られるものではなく、適宜任意に変更可能である。
即ち、補正制御部6cは、判定部c1により第1ベクトルと第2ベクトルとの大きさの差が第1判定値よりも大きいと判定された場合に、第1補正部6aに第1補正処理を実行させる。また、補正制御部6cは、判定部c1により第1ベクトルと第2ベクトルとの方向のずれ量が第2判定値よりも大きいと判定された場合に、第1補正部6aに第1補正処理を実行させる。
なお、判定部c1は、GPS処理部2により測定済みの移動経路の始点Aと測位再開地点Bとの距離が所定値よりも大きいか否かを判定し、補正制御部6cは、判定部c1により距離が所定値よりも大きいと判定された場合に、第1補正部6aに第1補正処理を実行させるようにしても良い。
また、補正制御部6cは、判定部c1により第1ベクトルと第2ベクトルとの大きさの差が第1判定値よりも大きくないと判定され、かつ、判定部c1により第1ベクトルと第2ベクトルとの方向のずれ量が第2判定値よりも大きくないと判定された場合に、第2補正部6bに第2補正処理(詳細後述)を実行させる。
即ち、第1補正部6aは、受信アンテナ2aによる信号の受信の再開後、GPS測位された測位再開地点Bと移動経路の終点B1との差異量に、始点Aから移動経路の各地点までの移動量に応じた比率を乗じた変位量を、自律航法測位された移動経路の各地点の位置に係る位置データに付加することで、当該各地点の位置データを補正する処理を行う。
X2=X1+(Lx/L0)×Vb …式(1)
ここで、X2,X1は補正前と補正後の位置データであり、地点を表わす記号(X2,X1)と同一の記号を用いている。また、L0は軌跡T1に沿った始点Aから終点B1までの全長(経路長)、Lxは軌跡T1に沿った始点Aから補正対象地点X1までの経路長である。
なお、経路長L0,Lxは、自律航法測位の際に移動量を積算しておくことで求めて、各位置データと対応させて記憶させておくようにしても良い。或いは、移動経路に沿った各位置データが比較的細かな間隔で取得されている場合には、補正演算時に一連の位置データから各位置データの前後の差分量を積算して求めるようにしても良い。
ここで、第1補正部6aは、移動経路の第1地点(始点A)から所定の地点までの自律航法測位により取得された移動経路における経路長を各地点X1について算出する算出手段を構成している。
このような位置データの補正が、移動経路の始点Aから終点B1にかけて軌跡T1を表わす一連の位置データに対して行われる。これにより、始点Aから終点B1にかけた補正後の位置データを得ることができる。なお、補正後の一連の位置データに対応する軌跡T2を実線で表す(図5(c)参照)。
即ち、第2補正部6bは、測位再開地点Bと移動経路の終点B1との差異量に、始点Aからの移動量に応じた比率を乗じ、且つ、始点Aを中心とした当該始点Aからの角度変位に応じた回転量を付加した変位量を、始点Aから移動経路における各地点X1の位置データに付加することで、当該各地点X1の位置データを補正する。
X2=X1+Vx
|Vx|=|Vb|×(LAX1/LAB1)
Vxの方向=Vbの方向+θx …式(2)
ここで、X1は軌跡T1上の補正対象の位置データ、X2は補正後の位置データ、Vxは補正対象地点の変位ベクトル、LAB1は線分A・B1の長さ、LAX1は線分A・X1の長さ、θxは線分A・B1と線分A・X1とのなす角度である。
即ち、第2補正部6bは、移動経路の終点B1の差異量に係る基準ベクトルVbを、始点Aから地点X1までの直線距離(LAX1)に応じた比率(LAX1/LAB1)でその大きさを変化させ、且つ、このベクトルVbの向きを、始点Aを中心とした地点B1から地点X1までの変位角度θxだけ変化させて、地点X1に対応する変位ベクトルVxを求める。そして、第2補正部6bは、変位ベクトルVxを地点X1の位置データに加算することで、補正後の地点X2の位置データを算出する。
このように、補正前の軌跡T1と補正後の軌跡T2とは、一方を拡大又は縮小することで合同となりえる図形であり、補正後の軌跡T2は、移動経路の補正前の軌跡T1の形状が保持されていると言える。
なお、計時部7は、取得した時刻情報に基づいて、日付や曜日等の暦を特定しても良い。
なお、上記した地図データベース9は、一例であってこれに限られるものではなく、当該データベースに記憶される情報の内容等は適宜任意に変更可能である。
図2は、測位処理に係る動作の一例を示すフローチャートである。
これにより、移動経路の始点Aの位置データがデータ記憶部5に記憶されたものとする。
具体的には、自律航法制御処理部4は、3軸地磁気センサ3aの出力に現れる歩行時特有の出力変動パターンから移動方向を算出する。また、自律航法制御処理部4は、3軸加速度センサ3bの出力から測位装置100の上下動の認識処理を行い、この上下動から歩数を求めて歩幅データと乗算することで、歩行による移動量を算出する。また、自律航法制御処理部4は、これら移動方向と移動量の算出に加えて、気圧センサ3cの出力値の変化から高さ方向の移動量についても算出する。そして、自律航法制御処理部4は、検出データを取得する直前の当該装置本体の存する現在位置(GPS測位された始点A)の位置データに、算出された移動方向及び移動量からなるベクトルデータを加算することで、自律航法の測位結果である位置データを算出する。
そして、自律航法制御処理部4は、測位演算された地点の位置データをデータ記憶部5に転送して、計時部7により計時された時刻データと対応付けて記憶させる(ステップS4)。
ここで、GPS測位処理の実行タイミングでないと判定されると(ステップS5;NO)、中央制御部1のCPUは、処理をステップS3に戻し、自律航法制御処理部4に自律航法測位処理を実行させる(ステップS3)。
即ち、自律航法制御処理部4は、間欠的に行われるGPS測位の実行タイミング以外のタイミングでも、自律航法測位処理を実行し、測位演算された地点の位置データは、時刻データと対応付けられてデータ記憶部5に逐次記憶される。
続けて、中央制御部1のCPUは、GPS処理部2により当該装置本体の存する現在位置がGPS測位されたか否かを判定する(ステップS7)。
即ち、自律航法制御処理部4は、例えば、屋内などをユーザが移動中にて、GPS処理部2により現在位置がGPS測位されなかった場合に、自律航法測位処理を実行し、測位演算された地点の位置データは、時刻データと対応付けられてデータ記憶部5に逐次記憶される。
これにより、例えば、屋内などを移動中のユーザが屋外に出て、GPS測位が再開された測位再開地点Bの位置データがデータ記憶部5に記憶される。また、測位再開地点BがGPS測位された時点で、既に自律航法測位されてデータ記憶部5に記憶されている地点の位置データが移動経路の終点B1の位置データとなる。
そして、判定部c1は、第1ベクトルと第2ベクトルとの方向のずれ量が第2判定値よりも大きいか否かを判定する(ステップS11)。ここで、第1ベクトルと第2ベクトルとの方向のずれ量が第2判定値よりも大きいと判定されると(ステップS11;YES:図5(a)参照)、補正制御部6cは、第1補正部6aに第1補正処理(図3参照)を実行させる(ステップS12)。
ここで、第1ベクトルと第2ベクトルの大きさの差が第1判定値よりも大きいと判定されると(ステップS13;YES:図5(a)参照)、補正制御部6cは、処理をステップS12に移行して、第1補正部6aに第1補正処理を実行させる(ステップS12)。一方、第1ベクトルと第2ベクトルの大きさの差が第1判定値よりも大きくないと判定されると(ステップS13;NO:図6(a)参照)、補正制御部6cは、第2補正部6bに第2補正処理(図4参照)を実行させる(ステップS14)。
図3は、測位処理における第1補正処理に係る動作の一例を示すフローチャートである。また、図5(a)〜図5(c)は、第1補正処理を説明するための図である。
第1補正処理では、第1補正部6aは、自律航法測位された移動経路の各地点X1の位置データを下記式(1)に従って補正する。
X2=X1+(Lx/L0)×Vb …式(1)
次に、第1補正部6aは、データ記憶部5の移動履歴データ5bを読み出し当該移動履歴データ5bに基づいて、移動経路の軌跡T1に沿った始点Aから終点B1までの全長(経路長)L0を算出する(ステップS22)。続けて、第1補正部6aは、データ記憶部5の移動履歴データ5bを読み出し当該移動履歴データ5bに基づいて、移動経路の補正対象となる各地点X1までの軌跡T1に沿った始点Aからの各経路長Lxを算出する(ステップS23)。
これにより、第1補正処理を終了する。
図4は、測位処理における第2補正処理に係る動作の一例を示すフローチャートである。また、図6(a)及び図6(b)は、第2補正処理を説明するための図である。
第2補正処理では、第2補正部6bは、自律航法測位された移動経路の各地点X1の位置データを下記式(2)に従って補正する。
X2=X1+Vx
|Vx|=|Vb|×(LAX1/LAB1)
Vxの方向=Vbの方向+θx …式(2)
次に、第2補正部6bは、データ記憶部5の移動履歴データ5bを読み出し、移動経路の始点A及び終点B1の位置データに基づいて始点Aと終点B1を結ぶ線分A・B1の直線距離(長さ)LAB1を算出する(ステップS32;図6(b)参照)。続けて、第2補正部6bは、データ記憶部5の移動履歴データ5bを読み出し当該移動履歴データ5bに基づいて、移動経路の始点Aと補正対象となる各地点X1を結ぶ線分A・X1の直線距離(長さ)LAX1を算出する(ステップS33;図6(b)参照)。
これにより、第2補正処理を終了する。
より具体的には、測位再開地点Bと移動経路の終点B1との差異量に、始点Aから移動経路の各地点までの移動量に応じた比率を乗じた変位量を、自律航法測位された移動経路の各地点の位置に係る位置データに付加することで、当該各地点の位置データを補正するので、移動経路の各地点までの始点Aからの直線距離を基準として補正する場合に比べて、当該移動経路の各地点の位置の補正精度を向上させることができる。つまり、移動経路の各地点までの始点Aからの直線距離を基準として補正する場合には、測位再開地点Bの位置と移動経路の終点B1の位置との差異量が所定値よりも大きいと、GPS測位による測位再開地点Bと移動経路の終点B1との測定誤差によって移動経路の各地点の位置を誇張して拡大または縮小する補正を行うことがある。そこで、始点Aから終点B1の移動経路の全長(経路長)に対する始点Aから所定の地点までの移動量に基づいて補正をすることで、測定誤差の影響を受けることなく当該移動経路の各地点の位置の補正を適正に行うことができる。
また、GPS測位された測位再開地点Bの位置と自律航法測位された移動経路の終点B1の位置との差異量が所定値よりも大きくない場合には、移動経路の軌跡T1の形状を保持させるように、例えば回転や倍率変更等により当該移動経路の各地点を補正しても支障が生じ難いと考えられるため、より簡便な方法で補正処理を行うことで当該補正処理の高速化を図ることができる。
実施形態2の測位装置200は、実施形態1の測位装置100とは異なる第1補正処理(図8参照)を実行する。
なお、実施形態2の測位装置200は、以下に詳細に説明する以外の点で上記実施形態1の測位装置100と略同様の構成をなし、詳細な説明は省略する。
図7に示すように、補正処理部6の第1補正部206aは、移動経路における始点Aから所定の移動量の地点Cの位置を補正する第1補正処理を実行する。
ここで、所定の移動量の地点Cとしては、移動経路上の始点Aからの移動量が当該移動経路の全長の略半分の長さとなる地点(例えば、中点)が挙げられるが、一例であってこれに限られるものではなく、適宜任意に変更可能である。
具体的には、第1補正部206aは、先ず、測位再開地点Bと移動経路の終点B1との差異量として、移動経路の終点B1から測位再開地点Bに向かう基準ベクトルVbを算出する。そして、第1補正部206aは、基準ベクトルVbに始点Aから所定の基準地点C(例えば、中点)までの移動量に応じた比率を乗じて第1仮基準ベクトルV1を算出する。そして、第1補正部206aは、算出された第1仮基準ベクトルV1を、自律航法測位された所定の基準地点Cの位置に係る位置データに付加することで、所定の基準地点Cの位置データを、第1仮終点C1を表わす位置データへと下記式(3)に従って補正する。
C1=C+V1
V1=(Lc1/L0)×Vb …式(3)
ここで、C,C1は補正前と補正後の位置データであり、地点を表わす記号(C,C1)と同一の記号を用いている。また、L0は軌跡T1に沿った始点Aから終点B1までの全長(経路長)、Lc1は軌跡T1に沿った始点Aから所定の基準地点Cまでの経路長である。
具体的には、第1補正部206aは、先ず、所定の基準地点Cと第1仮終点C1との差異量に係る第1仮基準ベクトルV1の大きさに始点Aから移動経路の各地点X1までの直線距離に応じた比率を乗じ、且つ、始点Aを中心とした第1仮終点C1からの角度変位に応じた回転量を付加した変位量を算出する。そして、第1補正部206aは、算出された変位量を自律航法測位された移動経路の始点Aから所定の基準地点Cまでの各地点X1の位置に係る位置データに付加することで、移動経路の任意の地点X1の位置データを地点X2の示す位置データへと下記式(4)に従って補正する。
X2=X1+Vx
|Vx|=|V1|×(LAX1/LAC1)
Vxの方向=V1の方向+θx …式(4)
ここで、X1は軌跡T1上の補正対象の位置データ、X2は補正後の位置データ、Vxは補正対象地点の変位ベクトル、V1は第1仮基準ベクトル、LAC1は線分A・C1の長さ、LAX1は線分A・X1の長さ、θxは線分A・C1と線分A・X1とのなす角度である。
即ち、第1補正部206aは、所定の基準地点Cと第1仮終点C1との差異量に係る第1仮基準ベクトルV1を、始点Aから地点X1までの直線距離(LAX1)に応じた比率(LAX1/LAC1)でその大きさを変化させ、且つ、このベクトルV1の向きを、始点Aを中心とした第1仮終点C1から地点X1までの変位角度θxだけ変化させて、地点X1に対応する変位ベクトルVxを求める。そして、第1補正部206aは、変位ベクトルVxを地点X1の位置データに加算することで、補正後の地点X2の位置データを算出する。
具体的には、第1補正部206aは、第1仮基準ベクトルV1を、自律航法測位された移動経路の所定の基準地点Cから終点B1までの各地点X1の位置に係る位置データに付加することで、移動経路の任意の地点X1の位置データを地点X2の示す位置データへと下記式(5)に従って仮補正する。
X2=X1+V1 …式(5)
ここで、X1は軌跡T1上の補正対象の位置データ、X2は仮補正後の位置データ、V1は第1仮基準ベクトルである。
これにより、移動経路の終点B1を補正対象の地点X1とした場合に、当該終点B1の位置データが補正された地点X2、即ち、第2仮終点B2の位置データが特定される。なお、図10(b)に仮補正された移動経路の軌跡T3を点線で表す。
具体的には、第1補正部206aは、先ず、測位再開地点Bと第2仮終点B2との差異量として、第2仮終点B2及び測位再開地点Bの位置データに基づいて第2仮終点B2から測位再開地点Bに向かう第2仮基準ベクトルV2を算出する。そして、第1補正部206aは、第2仮基準ベクトルV2の大きさに仮始点Dから移動経路の各地点X1までの直線距離に応じた比率を乗じ、且つ、仮始点Dを中心とした第2仮終点B2からの角度変位に応じた回転量を付加した変位量を算出する。そして、第1補正部206aは、算出された変位量を仮始点Dから第2仮終点B2までの各地点X1の位置に係る位置データに付加することで、移動経路の任意の地点X1の位置データを地点X2の示す位置データへと下記式(6)に従って補正する。
X2=X1+Vx
|Vx|=|V2|×(LDX1/LDB2)
Vxの方向=V2の方向+θx …式(6)
ここで、X1は軌跡T1上の補正対象の位置データ、X2は補正後の位置データ、Vxは補正対象地点の変位ベクトル、LDB2は線分DA・B2の長さ、LDX1は線分D・X1の長さ、θxは線分D・B2と線分D・X1とのなす角度である。
即ち、第1補正部206aは、測位再開地点Bと第2仮終点B2との差異量に係る第2仮基準ベクトルV2を、仮始点Dから地点X1までの直線距離(LDX1)に応じた比率(LDX1/LDB2)でその大きさを変化させ、且つ、このベクトルV2の向きを、仮始点Dを中心とした第2仮終点B2から地点X1までの変位角度θxだけ変化させて、地点X1に対応する変位ベクトルVxを求める。そして、第1補正部206aは、変位ベクトルVxを地点X1の位置データに加算することで、補正後の地点X2の位置データを算出する。
図8は、測位処理における第1補正処理に係る動作の一例を示すフローチャートである。また、図9(a)〜図9(c)並びに図10(a)〜図10(c)は、第1補正処理を説明するための図である。
なお、図9(a)〜図9(c)並びに図10(a)〜図10(c)にあっては、受信アンテナ2aにより信号受信(GPS測位)が行われずに自律航法測位が行われる領域Rを破線で模式的に表している。
そして、ステップS11にて、第1ベクトルと第2ベクトルとの方向のずれ量が第2判定値よりも大きいと判定されるか(ステップS11;YES:図9(a)参照)、ステップS13にて、第1ベクトルと第2ベクトルの大きさの差が第1判定値よりも大きいと判定されると(ステップS13;YES:図9(a)参照)、補正制御部6cは、第1補正部206aに第1補正処理(図8参照)を実行させる(ステップS12)。
なお、第2補正部6bによる第2補正処理(図4参照)の内容は、上記実施形態1の測位装置100による第2補正処理と略同様であり、その詳細な説明は省略する。
図8に示すように、第1補正部206aは、先ず、測位再開地点Bと移動経路の終点B1との差異量として、移動経路の終点B1から測位再開地点Bに向かう基準ベクトルVbを算出する(ステップS41;図9(b)参照)。
次に、第1補正部206aは、データ記憶部5の移動履歴データ5bを読み出し当該移動履歴データ5bに基づいて、移動経路の軌跡T1に沿った始点Aから終点B1までの全長(経路長)L0を算出する(ステップS42)。続けて、第1補正部206aは、データ記憶部5の移動履歴データ5bを読み出し当該移動履歴データ5bに基づいて、移動経路の始点Aから所定の地点C(例えば、中点)までの軌跡T1に沿った経路長Lc1を算出する(ステップS43)。
C1=C+V1
V1=(Lc1/L0)×Vb …式(3)
X2=X1+Vx
|Vx|=|V1|×(LAX1/LAC1)
Vxの方向=V1の方向+θx …式(4)
X2=X1+V1 …式(5)
そして、第1補正部206aは、第2仮基準ベクトルV2の大きさに仮始点Dからから移動経路の各地点X1までの直線距離LDX1に応じた比率を乗じ、且つ、仮始点Dを中心とした第2仮終点B2からの角度変位θx(線分D・B2と線分D・X1とのなす角度)に応じた回転量を付加した変位ベクトル(変位量)Vxを算出する(ステップS54;図10(c)参照)。続けて、第1補正部206aは、算出された変位ベクトルVxを仮始点Dから第2仮終点B2までの各地点X1の位置に係る位置データに付加することで、移動経路の任意の地点X1の位置データを補正後の地点X2を表わす位置データへと下記式(6)に従って補正する(ステップS55;図10(c)参照)。そして、補正された地点X2の位置データがデータ記憶部5の移動履歴データ5bの補正前の地点X1の位置データに上書きされて記憶される(ステップS56)。
X2=X1+Vx
|Vx|=|V2|×(LDX1/LDB2)
Vxの方向=V2の方向+θx …式(6)
これにより、第1補正処理を終了する。
より具体的には、移動経路における所定の地点Cの位置データを補正して第1仮終点C1を特定して、所定の地点Cと第1仮終点C1との差異量に、移動経路の始点Aからの距離に応じた比率を乗じ、且つ、始点Aを中心とした第1仮終点C1からの角度変位に応じた回転量を付加した変位量を、始点Aから所定の地点Cまでの各地点の位置データに付加することで、当該各地点の位置データを補正することができる。そして、第1仮終点C1の位置を基準として、移動経路の終点B1の位置データを補正して第2仮終点B2を特定した後、第1仮終点C1を仮始点Dとして、測位再開地点Bと第2仮終点B2との差異量に、仮始点Dからの距離に応じた比率を乗じ、且つ、仮始点Dを中心とした第2仮終点B2からの角度変位に応じた回転量を付加した変位量を、仮始点Dから第2仮終点B2までの各地点の位置データに付加することで、当該各地点の位置データを補正することができる。つまり、移動経路における始点Aから所定の基準地点Cまでと当該所定の地点Cから終点B1までとに分けて当該移動経路の各地点の位置を補正することができ、当該移動経路の各地点の位置を一括して補正する場合に比べて、GPS測位による測位再開地点Bの測定誤差の影響を受けることなく当該移動経路の各地点の位置の補正を適正に行うことができる。
即ち、始点Aの位置や終点B1の位置に対して所定の地点Cの位置が十分に離れている状態では、分けられた各移動経路の軌跡T1の形状を保持させるように、例えば回転や倍率変更等により当該移動経路の各地点を補正しても支障が生じ難いと考えられるため、より簡便な方法で補正処理を行うことで当該補正処理の高速化を図ることができる。
特に、所定の地点Cを、移動経路の始点Aからの移動量が当該移動経路の全長の略半分の長さに設定することで、当該所定の地点Cを移動経路の始点Aから離れた位置に設定することができ、移動経路における始点Aからの移動量が略半分の地点までと残りの半分である終点B1までとに分けて当該移動経路の各地点の位置を適正に補正することができる。
実施形態3の測位装置300は、実施形態1の測位装置100とは異なる測位処理(図12参照)を実行する。
なお、実施形態3の測位装置300は、以下に詳細に説明する以外の点で上記実施形態1の測位装置100と略同様の構成をなし、詳細な説明は省略する。
図11に示すように、補正処理部6の補正制御部306cは、第1判定部c2と第2判定部c3とを具備し、当該第1判定部c2及び第2判定部c3による判定結果に応じて、補正処理部6による自律航法測位により得られた位置データの補正処理の内容を変更させる制御を行う。
即ち、第1判定部c2は、第1判定手段として、GPS処理部2により測定された測位再開地点Bの位置と、自律航法制御処理部4により測定された移動経路の終点(第2地点)B1の位置との差異量が所定値よりも大きいか否かを判定する。
なお、第1判定部c2による判定処理の内容は、上記実施形態1、2の判定部c1による判定処理の内容と略同様であり、その詳細な説明は省略する。
即ち、当該装置本体を所持するユーザが所定方向(例えば、図14(b)中、太い矢印で示す方向)に移動することで、測位再開地点Bから次第に離れて行く場合に、第2判定部c3は、GPS処理部2により測位再開地点Bの測位後に新たに測定された新測位地点Eの位置と、その新測位地点Eに対応する移動経路の第3地点E1の位置との差異量が所定値よりも大きいか否かを判定する。
具体的には、第2判定部c3は、移動経路の始点(第1地点)AからGPS処理部2により新たに測定された新測位地点Eに向かう第3ベクトルを算出する。また、第2判定部c3は、移動経路の始点(第1地点)Aから移動経路の第3地点E1に向かう第4ベクトルを算出する。そして、第2判定部c3は、第3ベクトルと第4ベクトルの各々の大きさを算出して、これらの大きさの差(差異量)が第1判定値(所定値)よりも大きいか否かを判定する。ここで、第1判定値は、例えば、第3ベクトル及び第4ベクトルの大きさの何れか一方を基準として他方に対する差が所定の割合(例えば、20%程度)となるような値に設定されている。
なお、第2判定部c3による判定処理は、第1判定部c2による判定処理後に所定時間が経過する毎に行われても良い。
即ち、補正制御部306cは、第2判定部c3により第3ベクトルと第4ベクトルとの大きさの差が第1判定値よりも大きくないと判定された場合に、第2補正部6bに移動経路の軌跡T1の形状を保持させるように移動経路の各地点の位置を補正させる第2補正処理を実行させる(図14(c)参照)。
なお、第2補正処理の内容は、上記実施形態1、2の第2補正部6bによる第2補正処理の内容と略同様であり、その詳細な説明は省略する。
図12及び図13は、測位処理に係る動作の一例を示すフローチャートである。また、図14(a)〜図14(c)は、測位処理を説明するための図である。
なお、図14(a)〜図14(c)にあっては、受信アンテナ2aにより信号受信(GPS測位)が行われずに自律航法測位が行われる領域Rを破線で模式的に表している。
そして、ステップS11にて、第1ベクトルと第2ベクトルとの方向のずれ量が第2判定値よりも大きいと判定されるか(ステップS11;YES:図14(a)参照)、ステップS13にて、第1ベクトルと第2ベクトルの大きさの差が第1判定値よりも大きいと判定されると(ステップS13;YES:図14(a)参照)、中央制御部1のCPUは、自律航法測位を行う(ステップS61)。そして、自律航法制御処理部4は、測位演算された地点の位置データをデータ記憶部5に転送して、計時部7により計時された時刻データと対応付けて記憶させる(ステップS62)。次に、GPS処理部2は、受信アンテナ2aによるGPS信号の受信に基づいて当該装置本体の存する現在位置の測位(GPS測位)を行う(ステップS63)。GPS処理部2は、受信アンテナ2aにより受信されたGPS信号に基づいて測位演算された現在位置の位置データをデータ記憶部5に転送して、計時部7により計時された時刻データと対応付けて記憶させる(ステップS64)。続けて、補正制御部306cは、GPS処理部2により測定済みの移動経路の始点Aから測位地点Eに向かう第3ベクトルと、始点Aから測位地点Eに対応する移動経路の第3地点E1に向かう第4ベクトルとを各々算出する(ステップS65)。
次に、第2判定部c3は、第3ベクトルと第4ベクトルの各々の大きさを算出して、これらの大きさの差が第1判定値よりも大きいか否かを判定する(ステップS67)。
ここで、第3ベクトルと第2ベクトルとの大きさの差が第1判定値よりも大きくないと判定されると(ステップS67;NO)、補正制御部306cは、処理をステップS14に移行して、第2補正部6bに第2補正処理(図12参照)を実行させる(ステップS14)。
これにより、第2補正部6bは、移動経路の軌跡T1の形状を保持させるように移動経路の各地点の位置を補正する第2補正処理を実行する(図14(c)参照)。なお、第2補正部6bによる第2補正処理(図4参照)の内容は、上記実施形態1の測位装置100による第2補正処理と略同様であり、その詳細な説明は省略する。
即ち、GPS測位され、移動経路の各地点の補正の基準となる地点(新測位地点)が移動経路の始点Aから十分に離れている状態では、移動経路の軌跡T1の形状を保持させるように、例えば回転や倍率変更等により当該移動経路の各地点を補正しても支障が生じ難いと考えられるため、より簡便な方法で補正処理を行うことで当該補正処理の高速化を図ることができる。
例えば、上記実施形態1〜3にあっては、第2補正処理として、移動経路の軌跡T1の形状を保持させるように前記移動経路の各地点の位置を補正させる処理を例示したが、一例であってこれに限られるものではなく、例えば、移動経路の終点B1の位置のみを測位再開地点Bの位置に補正する処理など適宜任意に変更可能である。
即ち、プログラムを記憶するプログラムメモリ(図示略)に、第1測位処理ルーチン、第2測位処理ルーチン、補正処理ルーチン、判定処理ルーチン、算出処理ルーチン、制御処理ルーチンを含むプログラムを記憶しておく。そして、第1測位処理ルーチンにより中央制御部1のCPUを、測位衛星から送信されて受信手段により受信された信号に基づいて、当該装置本体の現在位置を測位し、位置データを取得する第1測位手段として機能させるようにしても良い。また、第2測位処理ルーチンにより中央制御部1のCPUを、当該装置本体の移動方向及び移動量を連続的に検出し、予め第1測位手段により測定済みの第1地点の位置データに移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位手段として機能させるようにしても良い。また、補正処理ルーチンにより中央制御部1のCPUを、第1測位手段により取得された測位地点の位置データに基づいて、第2測位手段により取得された移動経路の各地点の位置データを補正する補正手段として機能させるようにしても良い。また、判定処理ルーチンにより中央制御部1のCPUを、第1測位手段により取得された測位地点の位置データと、当該測位地点に対応する第2測位手段により取得された移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する判定手段として機能させるようにしても良い。また、算出処理ルーチンにより中央制御部1のCPUを、第1地点から所定の地点までの第2測位手段により取得された移動経路における経路長を各地点について算出する算出手段として機能させるようにしても良い。また、制御処理ルーチンにより中央制御部1のCPUを、判定手段により差異量が所定値よりも大きいと判定された場合に、算出手段により算出された第1地点から第2地点までの経路長に対する移動経路の各地点までの経路長に基づいて、補正手段に対し、移動経路の各地点の位置データを補正させる第1補正処理を実行させる制御手段として機能させるようにしても良い。
即ち、プログラムを記憶するプログラムメモリ(図示略)に、第1測位処理ルーチン、第2測位処理ルーチン、補正処理ルーチン、第1判定処理ルーチン、第2判定処理ルーチン、制御処理ルーチンを含むプログラムを記憶しておく。そして、第1測位処理ルーチンにより中央制御部1のCPUを、測位衛星から送信されて受信手段により受信された信号に基づいて、当該装置本体の現在位置を測位し、位置データを取得する第1測位手段として機能させるようにしても良い。また、第2測位処理ルーチンにより中央制御部1のCPUを、当該装置本体の移動方向及び移動量を連続的に検出し、予め第1測位手段により測定済みの第1地点の位置データに移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位手段として機能させるようにしても良い。また、補正処理ルーチンにより中央制御部1のCPUを、第1測位手段により取得された測位地点の位置データに基づいて、第2測位手段により取得された移動経路の各地点の位置データを補正する補正手段として機能させるようにしても良い。また、第1判定処理ルーチンにより中央制御部1のCPUを、第1測位手段により取得された測位地点の位置データと、当該測位地点に対応する第2測位手段により取得された移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する第1判定手段として機能させるようにしても良い。また、第2判定処理ルーチンにより中央制御部1のCPUを、第1判定手段により差異量が所定値よりも大きいと判定された場合に、第1測位手段により測位地点の測位後に新たに測定された新測位地点の位置データと当該新測位地点に対応する第2測位手段により取得された移動経路の第3地点の位置データとの差異量が所定値よりも大きいか否かを判定する第2判定手段として機能させるようにしても良い。また、制御処理ルーチンにより中央制御部1のCPUを、第2判定手段により差異量が所定値よりも大きくないと判定された場合に、補正手段に対し、移動経路の軌跡の形状を保持させるように移動経路の各地点の位置データを補正させる補正処理を実行させる制御手段として機能させるようにしても良い。
以下に、この出願の願書に最初に添付した特許請求の範囲に記載した発明を付記する。付記に記載した請求項の項番は、この出願の願書に最初に添付した特許請求の範囲の通りである。
〔付記〕
<請求項1>
使用者によって所持される測位装置であって、
測位衛星から送信された信号を受信する受信手段と、
この受信手段により受信された信号に基づいて、当該装置本体の現在位置を測位し、その位置データを取得する第1測位手段と、
当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位手段により測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位手段と、
前記第1測位手段により取得された測位地点の位置データに基づいて、前記第2測位手段により取得された前記移動経路の各地点の位置データを補正する補正手段と、
前記第1測位手段により取得された測位地点の位置データと、当該測位地点に対応する前記第2測位手段により取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する判定手段と、
前記第1地点から所定の地点までの前記第2測位手段により取得された前記移動経路における経路長を各地点について算出する算出手段と、
前記判定手段により前記差異量が所定値よりも大きいと判定された場合に、前記算出手段により算出された前記第1地点から前記第2地点までの経路長に対する前記移動経路の各地点までの経路長に基づいて、前記補正手段に対し、前記移動経路の各地点の位置データを補正させる第1補正処理を実行させる制御手段と、
を備えたことを特徴とする測位装置。
<請求項2>
前記制御手段は、更に、
前記判定手段により前記差異量が所定値よりも大きくないと判定された場合に、前記補正手段に対し、前記移動経路の軌跡の形状を保持させるように前記移動経路の各地点の位置データを補正させる第2補正処理を実行させることを特徴とする請求項1に記載の測位装置。
<請求項3>
前記判定手段は、更に、
前記第1測位手段により測定済みの前記第1地点から前記測位地点に向かう第1方向と、前記第1地点から前記第2地点に向かう第2方向とのずれ量が所定値よりも大きいか否かを判定し、
前記制御手段は、
前記判定手段により前記第1方向と前記第2方向とのずれ量が所定値よりも大きいと判定された場合に、前記第1補正処理を実行させることを特徴とする請求項1又は2に記載の測位装置。
<請求項4>
前記第1補正処理は、
前記測位地点と前記第2地点との差異量に、前記第1地点から前記第2地点までの経路長に対する前記第1地点から前記移動経路の各地点までの経路長に応じた比率を乗じた変位量を算出し、当該変位量を前記第2測位手段により測定された前記移動経路の各地点の位置に係る位置データに付加することで、当該各地点の位置データを補正する処理を含むことを特徴とする請求項1〜3の何れか一項に記載の測位装置。
<請求項5>
前記第1補正処理は、
前記測位地点と前記第2地点との差異量に、前記第1地点から前記第2地点までの経路長に対する前記第1地点から所定の地点までの経路長に応じた比率を乗じた変位量を算出し、当該変位量を、所定の基準地点の位置に係る位置データに付加することで、当該所定の基準地点の位置データを補正して第1仮終点を特定する第1処理と、
前記所定の基準地点と前記第1仮終点との差異量に、前記第1地点からの距離に応じた比率を乗じ、且つ、前記第1地点を中心とした前記第1仮終点からの角度変位に応じた回転量を付加した変位量を、前記第1地点から所定の基準地点までの各地点の位置データに付加することで、当該各地点の位置データを補正する第2処理と、
前記第1仮終点の位置を基準として、前記第2地点の位置データを補正して第2仮終点を特定する第3処理と、
前記第1仮終点を仮始点として、前記測位地点と前記第2仮終点との差異量に、前記仮始点からの距離に応じた比率を乗じ、且つ、前記仮始点を中心とした前記第2仮終点からの角度変位に応じた回転量を付加した変位量を、前記仮始点から前記第2仮終点までの各地点の位置データに付加することで、当該各地点の位置データを補正する第4処理と、を含むことを特徴とする請求項1〜3の何れか一項に記載の測位装置。
<請求項6>
前記所定の基準地点は、前記移動経路の前記第1地点からの経路長が当該移動経路の全長の略半分の長さとなる地点を含むことを特徴とする請求項5に記載の測位装置。
<請求項7>
使用者によって所持される測位装置であって、
測位衛星から送信された信号を受信する受信手段と、
この受信手段により受信された信号に基づいて、当該装置本体の現在位置を測位し、その位置データを取得する第1測位手段と、
当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位手段により測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位手段と、
前記第1測位手段により取得された測位地点の位置データに基づいて、前記第2測位手段により取得された前記移動経路の各地点の位置データを補正する補正手段と、
前記第1測位手段により取得された測位地点の位置データと、当該測位地点に対応する前記第2測位手段により取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する第1判定手段と、
この第1判定手段により前記差異量が所定値よりも大きいと判定された場合に、前記第1測位手段により前記測位地点の測位後に新たに測定された新測位地点の位置データと当該新測位地点に対応する前記第2測位手段により取得された前記移動経路の第3地点の位置データとの差異量が所定値よりも大きいか否かを判定する第2判定手段と、
この第2判定手段により前記差異量が所定値よりも大きくないと判定された場合に、前記補正手段に対し、前記移動経路の軌跡の形状を保持させるように前記移動経路の各地点の位置データを補正させる補正処理を実行させる制御手段と、
を備えたことを特徴とする測位装置。
<請求項8>
使用者によって所持される測位装置を用いた測位方法であって、
測位衛星から送信されて受信手段により受信された信号に基づいて、当該装置本体の現在位置を測位し、位置データを取得する第1測位処理と、
当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位手段により測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位処理と、
前記第1測位処理にて取得された測位地点の位置データに基づいて、前記第2測位処理にて取得された前記移動経路の各地点の位置データを補正する補正処理と、
前記第1測位処理にて取得された測位地点の位置データと、当該測位地点に対応する前記第2測位処理にて取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する判定処理と、
前記第1地点から所定の地点までの前記第2測位処理にて取得された前記移動経路における経路長を各地点について算出する経路長算出処理と、
前記判定処理にて前記差異量が所定値よりも大きいと判定された場合に、前記経路長算出処理にて算出された前記第1地点から前記第2地点までの経路長に対する前記移動経路の各地点までの経路長に基づいて、前記補正処理にて前記移動経路の各地点の位置データを補正させる制御処理と、
を含むことを特徴とする測位方法。
<請求項9>
使用者によって所持される測位装置を用いた測位方法であって、
測位衛星から送信されて受信手段により受信された信号に基づいて、当該装置本体の現在位置を測位し、位置データを取得する第1測位処理と、
当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位処理にて測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位処理と、
前記第1測位処理にて取得された測位地点の位置データに基づいて、前記第2測位処理にて取得された前記移動経路の各地点の位置データを補正する補正処理と、
前記第1測位処理にて取得された測位地点の位置データと、当該測位地点に対応する前記第2測位処理にて取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する第1判定処理と、
この第1判定処理にて前記差異量が所定値よりも大きいと判定された場合に、前記第1測位処理にて前記測位地点の測位後に新たに測定された新測位地点の位置データと当該新測位地点に対応する前記第2測位手段により取得された前記移動経路の第3地点の位置データとの差異量が所定値よりも大きいか否かを判定する第2判定処理と、
この第2判定処理にて前記差異量が所定値よりも大きくないと判定された場合に、前記補正処理にて前記移動経路の軌跡の形状を保持させるように前記移動経路の各地点の位置データを補正させる制御処理と、
を含むことを特徴とする測位方法。
<請求項10>
使用者によって所持される測位装置のコンピュータを、
測位衛星から送信されて受信手段により受信された信号に基づいて、当該装置本体の現在位置を測位し、位置データを取得する第1測位手段、
当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位手段により測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位手段、
前記第1測位手段により取得された測位地点の位置データに基づいて、前記第2測位手段により取得された前記移動経路の各地点の位置データを補正する補正手段、
前記第1測位手段により取得された測位地点の位置データと、当該測位地点に対応する前記第2測位手段により取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する判定手段、
前記第1地点から所定の地点までの前記第2測位手段により取得された前記移動経路における経路長を各地点について算出する算出手段、
前記判定手段により前記差異量が所定値よりも大きいと判定された場合に、前記算出手段により算出された前記第1地点から前記第2地点までの経路長に対する前記移動経路の各地点までの経路長に基づいて、前記補正手段に対し、前記移動経路の各地点の位置データを補正させる第1補正処理を実行させる制御手段、
として機能させることを特徴とするプログラム。
<請求項11>
使用者によって所持される測位装置のコンピュータを、
測位衛星から送信されて受信手段により受信された信号に基づいて、当該装置本体の現在位置を測位し、位置データを取得する第1測位手段、
当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位手段により測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位手段、
前記第1測位手段により取得された測位地点の位置データに基づいて、前記第2測位手段により取得された前記移動経路の各地点の位置データを補正する補正手段、
前記第1測位手段により取得された測位地点の位置データと、当該測位地点に対応する前記第2測位手段により取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する第1判定手段、
この第1判定手段により前記差異量が所定値よりも大きいと判定された場合に、前記第1測位手段により前記測位地点の測位後に新たに測定された新測位地点の位置データと当該新測位地点に対応する前記第2測位手段により取得された前記移動経路の第3地点の位置データとの差異量が所定値よりも大きいか否かを判定する第2判定手段、
この第2判定手段により前記差異量が所定値よりも大きくないと判定された場合に、前記補正手段に対し、前記移動経路の軌跡の形状を保持させるように前記移動経路の各地点の位置データを補正させる補正処理を実行させる制御手段、
として機能させることを特徴とするプログラム。
1 中央制御部
2 GPS処理部
2a GPSアンテナ
3 センサ部
4 自律航法制御処理部
6 補正処理部
6a、206a 第1補正部
6b 第2補正部
6c、306c 補正制御部
c1 判定部
c2 第1判定部
c3 第2判定部
Claims (3)
- 使用者によって所持される測位装置であって、
測位衛星から送信された信号により当該装置本体の現在位置を測位し、その位置データを取得する第1測位手段と、
当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位手段により測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位手段と、
前記第1測位手段により取得された測位地点の位置データに基づいて、前記第2測位手段により取得された前記移動経路の各地点の位置データを補正する補正手段と、
前記第1測位手段により取得された測位地点の位置データと、当該測位地点に対応する前記第2測位手段により取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する第1判定手段と、
この第1判定手段により前記差異量が所定値よりも大きいと判定された場合に、前記第1測位手段により前記測位地点の測位後に新たに測定された新測位地点の位置データと当該新測位地点に対応する前記第2測位手段により取得された前記移動経路の第3地点の位置データとの差異量が所定値よりも大きいか否かを判定する第2判定手段と、
この第2判定手段により前記差異量が所定値よりも大きくないと判定された場合に、前記補正手段に対し、前記移動経路の軌跡の形状を保持させるように前記移動経路の各地点の位置データを補正させる補正処理を実行させる制御手段と、
を備えたことを特徴とする測位装置。 - 使用者によって所持される測位装置を用いた測位方法であって、
前記測位装置の第1測位手段が、測位衛星から送信された信号により当該装置本体の現在位置を測位し、位置データを取得する第1測位処理と、
前記測位装置の第2測位手段が、当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位処理にて測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位処理と、
前記測位装置の補正手段が、前記第2測位処理にて取得された前記移動経路の各地点の位置データを補正する補正処理と、
前記測位装置の第1判定手段が、前記第1測位処理にて取得された測位地点の位置データと、当該測位地点に対応する前記第2測位処理にて取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する第1判定処理と、
前記測位装置の第2判定手段が、この第1判定処理にて前記差異量が所定値よりも大きいと判定された場合に、前記第1測位処理にて前記測位地点の測位後に新たに測定された新測位地点の位置データと当該新測位地点に対応する前記第2測位処理により取得された前記移動経路の第3地点の位置データとの差異量が所定値よりも大きいか否かを判定する第2判定処理と、
前記測位装置の制御手段が、この第2判定処理にて前記差異量が所定値よりも大きくないと判定された場合に、前記補正処理にて前記移動経路の軌跡の形状を保持させるように前記移動経路の各地点の位置データを補正させる制御処理と、
を含むことを特徴とする測位方法。 - 使用者によって所持される測位装置のコンピュータを、
測位衛星から送信された信号により当該装置本体の現在位置を測位し、位置データを取得する第1測位手段、
当該装置本体の移動方向及び移動量を連続的に検出し、予め前記第1測位手段により測定済みの第1地点の位置データに前記移動方向及び移動量を積算していくことで、移動経路の各地点の位置データを取得する第2測位手段、
前記第1測位手段により取得された測位地点の位置データに基づいて、前記第2測位手段により取得された前記移動経路の各地点の位置データを補正する補正手段、
前記第1測位手段により取得された測位地点の位置データと、当該測位地点に対応する前記第2測位手段により取得された前記移動経路の第2地点の位置データとの差異量を算出し、当該差異量が所定値よりも大きいか否かを判定する第1判定手段、
この第1判定手段により前記差異量が所定値よりも大きいと判定された場合に、前記第1測位手段により前記測位地点の測位後に新たに測定された新測位地点の位置データと当該新測位地点に対応する前記第2測位手段により取得された前記移動経路の第3地点の位置データとの差異量が所定値よりも大きいか否かを判定する第2判定手段、
この第2判定手段により前記差異量が所定値よりも大きくないと判定された場合に、前記補正手段に対し、前記移動経路の軌跡の形状を保持させるように前記移動経路の各地点の位置データを補正させる補正処理を実行させる制御手段、
として機能させることを特徴とするプログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011218037A JP6014987B2 (ja) | 2011-09-30 | 2011-09-30 | 測位装置、測位方法及びプログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011218037A JP6014987B2 (ja) | 2011-09-30 | 2011-09-30 | 測位装置、測位方法及びプログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2013076677A JP2013076677A (ja) | 2013-04-25 |
JP6014987B2 true JP6014987B2 (ja) | 2016-10-26 |
Family
ID=48480248
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011218037A Active JP6014987B2 (ja) | 2011-09-30 | 2011-09-30 | 測位装置、測位方法及びプログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6014987B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150039224A1 (en) * | 2013-07-30 | 2015-02-05 | Here Global B.V. | Method and apparatus for detecting and sharing vehicle location |
JP2017125820A (ja) * | 2016-01-15 | 2017-07-20 | 三菱電機株式会社 | 情報処理装置及び情報処理方法及び情報処理プログラム |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3570372B2 (ja) * | 2000-11-08 | 2004-09-29 | 株式会社デンソー | 車両用現在位置検出装置、車両用現在位置表示装置、ナビゲーション装置および記録媒体 |
JP5609073B2 (ja) * | 2009-06-16 | 2014-10-22 | カシオ計算機株式会社 | 測位装置、測位方法およびプログラム |
-
2011
- 2011-09-30 JP JP2011218037A patent/JP6014987B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2013076677A (ja) | 2013-04-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5929230B2 (ja) | 測位装置、測位方法及びプログラム | |
JP4466705B2 (ja) | ナビゲーション装置 | |
US8554504B2 (en) | Positioning apparatus, positioning method and storage medium for positioning of pedestrian by autonomous navigation | |
JP4793479B2 (ja) | 測位装置、測位方法およびプログラム | |
JP5464101B2 (ja) | 測位装置、測位方法、および、プログラム | |
EP2264403B1 (en) | Positioning device and positioning method | |
US20100332126A1 (en) | Inertial navigation system with error correction based on navigation map | |
JP2012122819A (ja) | 測位装置、測位方法およびプログラム | |
JP6409297B2 (ja) | 測位装置、測位方法及びプログラム | |
JPH064023A (ja) | ナビゲーションシステム用軌跡表示装置 | |
JP2011058896A (ja) | 測位装置、測位方法およびプログラム | |
JP2019148586A (ja) | 位置計測装置、位置補正方法、及び位置情報取得システム | |
JP2008256620A (ja) | 地図データ修正装置、地図データ修正方法、及び地図データ修正プログラム | |
JP6014987B2 (ja) | 測位装置、測位方法及びプログラム | |
JP6060548B2 (ja) | 測位装置、測位方法及びプログラム | |
JP2016180626A (ja) | 電子機器、誤差補正方法及びプログラム | |
JP2016206017A (ja) | 電子機器、及び移動速度算出プログラム | |
JP2011007736A (ja) | 測位装置、測位方法およびプログラム | |
US7428461B2 (en) | Walker navigation device, walker navigation method, and program | |
JP2010032348A (ja) | 移動端末、現在位置表示方法、および現在位置表示プログラム | |
JP6492726B2 (ja) | 位置照合装置、位置照合方法及びプログラム | |
JP4646720B2 (ja) | ナビゲーション装置 | |
JP6410596B2 (ja) | 情報処理装置、プログラム | |
JP5953793B2 (ja) | 位置特定装置、位置特定方法及びプログラム | |
JP5817163B2 (ja) | 状態推定装置、電子機器及びプログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20140912 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20150526 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20150529 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150723 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20160119 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160318 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20160830 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160912 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6014987 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |