(57)【特許請求の範囲】
【請求項１】
３軸の加速度データを出力する加速度センサと、３軸の地磁気データを出力する地磁気センサと、前記加速度データ及び前記地磁気データから歩行者の進行方向を決定する進行方向決定手段とを有し、歩行者によって所持される携帯端末であって、
前記進行方向決定手段は、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する基準ベクトル導出手段と、
前記重力ベクトルと前記地磁気ベクトルからなる方位基準面の法線ベクトルを導出する方位基準面導出手段と、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する加速度面算出手段と、
前記方位基準面の法線ベクトルと前記加速度面の法線ベクトルとのなす角を方向角として算出する方向角算出手段と
を有することを特徴とする携帯端末。
【請求項２】
前記加速度センサから入力された前記加速度データを、歩数毎、又は歩数に基づく時間単位毎に区分し、前記進行方向決定手段へ出力する歩行タイミング決定手段と、
前記進行方向決定手段から出力された、前記歩数毎、又は歩数に基づく時間単位毎の進行方向について、方向転換がなされたか否かを判定する方向転換判定手段と
を更に有することを特徴とする請求項１に記載の携帯端末。
【請求項３】
歩行者の歩行の向き、即ち、加速度面の前方を決定する前方決定手段を更に有し、
前記前方決定手段は、前記加速度センサから出力された加速度データ列における合成加速度の連続するピーク点のうち大きい方を、加速度面の前方として決定し、その旨を前記方向転換判定手段へ通知することを特徴とする請求項２に記載の携帯端末。
【請求項４】
前記基準ベクトル導出手段に入力される前記加速度データ及び前記地磁気データについて、
所定時間範囲のデータをメモリし、最大値及び最小値から所定割合のデータを除去するフィルタ手段を更に有することを特徴とする請求項１から３のいずれか１項に記載の携帯端末。
【請求項５】
前記方向角算出手段から出力された前記方向角θについて、
所定時間範囲の方向角θをメモリし、当該方向角θの前後の変化が所定角度閾値以上となっている方向角θを除去する補正手段を更に有することを特徴とする請求項１から４のいずれか１項に記載の携帯端末。
【請求項６】
３軸の加速度データを出力する加速度センサと、３軸の地磁気データを出力する地磁気センサとを有し、歩行者によって所持される携帯端末に搭載されたコンピュータを、前記加速度データ及び前記地磁気データから前記歩行者の進行方向を決定する進行方向決定手段として機能させる携帯端末用のプログラムであって、
前記進行方向決定手段は、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する基準ベクトル導出手段と、
前記重力ベクトルと前記地磁気ベクトルからなる方位基準面の法線ベクトルを導出する方位基準面導出手段と、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する加速度面算出手段と、
前記方位基準面と前記加速度面の両平面の法線ベクトルのなす角を方向角として算出する方向角算出手段と
してコンピュータを機能させることを特徴とする携帯端末用のプログラム。
【請求項７】
３軸の加速度データを出力する加速度センサと、３軸の地磁気データを出力する地磁気センサとを有し、歩行者によって所持される携帯端末について、前記加速度データ及び前記地磁気データから前記歩行者の進行方向を決定する進行方向決定方法であって、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する第１のステップと、
前記重力ベクトルと前記重力ベクトルに対応する地磁気ベクトルの法線ベクトルを導出する第２のステップと、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する第３のステップと、
前記方位基準面と前記加速度面の法線ベクトルのなす角を方向角として算出する第４のステップと
を有することを特徴とする携帯端末の進行方向決定方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、加速度センサ及び地磁気センサを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法に関する。特に、進行方向及び現在位置をリアルタイムに導出する自律航法技術に関する。
【背景技術】
【０００２】
従来、加速度センサ及び方位センサを用いて、進行方向及び現在位置をリアルタイムに導出する自律航法技術がある。自律航法技術は、ＧＰＳ(Global Positioning System)技術と組み合わされて、主にカーナビゲーションシステム(Car Navigation System)に利用されている。カーナビゲーションシステムは、自動車の運転者に対して、正確な進行方向及び現在位置と、目的地への走行経路案内とを、ディスプレイに表示する。
【０００３】
カーナビゲーションシステムは、ＧＰＳによって測位した現在位置情報を、車速パルス又はジャイロのような自律航法技術によって補正する。また、道路地図情報を必要に応じて読み出し、現在の走行経路が道路上と一致するように、進行方向及び現在位置を補正する（投影法によるマップマッチング技術、例えば特許文献１参照）。これにより、センサの誤差によって、現在位置が、道路上でない位置になることを防ぐことができる。
【０００４】
これに対し、このようなナビゲーション技術を、歩行者の所持する携帯端末に適応したシステムもある。具体的には、検出した歩行者の「歩数」と、その歩行者の「歩幅」とを用いて、始点からの累積的な現在位置を導出する（例えば特許文献２参照）。自律航法技術を歩行者に適応した場合、水平方向の移動以外の加速度成分も検出される。従って、測定される距離は、単純に加速度センサの出力を積分するのではなく、歩数及び歩幅から導出される。
【０００５】
「歩数」は、携帯端末内の加速度センサによって検出された軸毎の加速度を二乗和の平方根とし（√(ｘ2＋ｙ2＋ｚ2)）、そのピーク−ピーク間を１歩として検出する（例えば特許文献３参照）。「歩幅」は、利用者が予め設定するか、若しくは利用者の身長から推定する。又は、他の技術によれば、歩行者に規定距離を歩行させることによって、その歩幅をキャリブレーションする技術もある（例えば非特許文献１参照）。
【０００６】
「進行方向」は、「方位センサ」によって検出される。方位センサとしては、一般に地磁気センサが利用される。地磁気センサを用いて検出した端末の姿勢及び方向を、ディスプレイに３次元表示する技術もある（例えば特許文献４参照）。また、進行方向に交差点を介して複数の道路が存在する場合、その交差点を、現在位置とする技術もある（例えば特許文献５参照）。
【０００７】
自律航法技術を用いた現在位置の決定について、センサデータの累積的誤差の影響を防ぐために、交差点での右折左折を検出した際に、その交差点を、現在位置の特定のための始点とする技術もある（例えば特許文献６参照）。即ち、方向転換が検出される毎に、センサデータの累積的誤差がリセットされることなり、その後の現在位置の特定に、先の累積的誤差が影響しない。
【０００８】
【特許文献１】特開平５−０６１４０８号公報
【特許文献２】特開平９−０８９５８４号公報
【特許文献３】特開２００５−０３８０１８号公報
【特許文献４】特開２００４−０４６００６号公報
【特許文献５】特開平３−０９９３９９号公報
【特許文献６】特開昭６３−０１１８１３号公報
【非特許文献１】「Nike＋iPodユーザーズガイド」、第２７頁、「online」、［平成２０年３月２５日検索］、インターネット＜ＵＲＬ：http://manuals.info.apple.com/ja/nikeipod_users_guide.pdf＞
【発明の開示】
【発明が解決しようとする課題】
【０００９】
特許文献４に記載された技術によれば、加速度センサ及び地磁気センサを用いて静止状態における方位を導出することができる。静止状態では、加速度センサによって検出される加速度ベクトルは、重力のみを表す。従って、その重力ベクトルとその地磁気ベクトルとを用いて導出される世界座標系から、方位を導出することができる。
【００１０】
しかしながら、実際に、歩行者に所持された携帯端末によって方位を導出する場合、手持ち状態のためにセンサによって検出される波形が乱れ、正しい方位を導出することはできない。特に、歩行時に生じる加速度ベクトルは、重力の他に、運動加速度や腕振り運動による遠心力などが合成されたものである。従って、重力方向を決定できないために世界座標系も導出できず、結局、方位を導出することもできない。また、歩行者が手持ちするような携帯端末については、サイズやコストの制約から、カーナビゲーションシステムに搭載されるジャイロセンサを用いることも難しい。
【００１１】
そこで、本発明は、歩行者が、携帯端末を手持ちで歩行している場合であっても、その携帯端末に搭載された加速度センサ及び地磁気センサを用いて、歩行者の進行方向をできる限り正確に決定する携帯端末、プログラム及び方法を提供することを目的とする。
【課題を解決するための手段】
【００１２】
本発明によれば、３軸の加速度データを出力する加速度センサと、３軸の地磁気データを出力する地磁気センサと、加速度データ及び地磁気データから歩行者の進行方向を決定する進行方向決定手段とを有し、歩行者によって所持される携帯端末であって、
進行方向決定手段は、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する基準ベクトル導出手段と、
重力ベクトルと地磁気ベクトルからなる方位基準面の法線ベクトルを導出する方位基準面導出手段と、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する加速度面算出手段と、
方位基準面の法線ベクトルと加速度面の法線ベクトルとのなす角を方向角として算出する方向角算出手段と
を有することを特徴とする。
【００１３】
本発明の携帯端末における他の実施形態によれば、
加速度センサから入力された加速度データを、歩数毎、又は歩数に基づく時間単位毎に区分し、進行方向決定手段へ出力する歩行タイミング決定手段と、
進行方向決定手段から出力された、歩数毎、又は歩数に基づく時間単位毎の進行方向について、方向転換がなされたか否かを判定する方向転換判定手段と
を更に有することも好ましい。
【００１４】
本発明の携帯端末における他の実施形態によれば、
歩行者の歩行の向き、即ち、加速度面の前方を決定する前方決定手段を更に有し、
前方決定手段は、加速度センサから出力された加速度データ列における合成加速度の連続するピーク点のうち大きい方を、加速度面の前方として決定し、その旨を方向転換判定手段へ通知することも好ましい。
【００１５】
本発明の携帯端末における他の実施形態によれば、
基準ベクトル導出手段に入力される加速度データ及び地磁気データについて、
所定時間範囲のデータをメモリし、最大値及び最小値から所定割合のデータを除去するフィルタ手段を更に有することも好ましい。
【００１６】
本発明の携帯端末における他の実施形態によれば、
方向角算出手段から出力された方向角θについて、
所定時間範囲の方向角θをメモリし、当該方向角θの前後の変化が所定角度閾値以上となっている方向角θを除去する補正手段を更に有することも好ましい。
【００１７】
本発明によれば、３軸の加速度データを出力する加速度センサと、３軸の地磁気データを出力する地磁気センサとを有し、歩行者によって所持される携帯端末に搭載されたコンピュータを、加速度データ及び地磁気データから歩行者の進行方向を決定する進行方向決定手段として機能させる携帯端末用のプログラムであって、
進行方向決定手段は、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する基準ベクトル導出手段と、
重力ベクトルと地磁気ベクトルからなる方位基準面の法線ベクトルを導出する方位基準面導出手段と、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する加速度面算出手段と、
方位基準面と加速度面の両平面の法線ベクトルのなす角を方向角として算出する方向角算出手段と
してコンピュータを機能させることを特徴とする。
【００１８】
本発明によれば、３軸の加速度データを出力する加速度センサと、３軸の地磁気データを出力する地磁気センサとを有し、歩行者によって所持される携帯端末について、加速度データ及び地磁気データから歩行者の進行方向を決定する進行方向決定方法であって、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する第１のステップと、
重力ベクトルと重力ベクトルに対応する地磁気ベクトルの法線ベクトルを導出する第２のステップと、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する第３のステップと、
方位基準面と加速度面の法線ベクトルのなす角を方向角として算出する第４のステップと
を有することを特徴とする。
【発明の効果】
【００１９】
本発明の携帯端末、プログラム及び方法によれば、加速度データ群の軌跡と北方位との方向角を算出できるので、歩行者が、携帯端末を手持ちで歩行している場合であっても、その携帯端末に搭載された加速度センサ及び地磁気センサを用いて、歩行者の進行方向をできる限り正確に決定することができる。
【発明を実施するための最良の形態】
【００２０】
以下では、図面を用いて、本発明を実施するための最良の形態について詳細に説明する。
【００２１】
図１は、歩行者の歩行態様と、加速度変動方向及び地磁気変動方向とを表す説明図である。
【００２２】
図１によれば、歩行者は、携帯端末を手持ちにし、その手を前後に振りながら歩行している。このような一般的な歩行態様を横方向から見れば、携帯端末の位置は、円弧を描きながら振り子状に前後に変動している。また、進行方向から見れば、携帯端末の位置は、上下に変動している。
【００２３】
携帯端末を手持ちした腕における肩部分は、携帯端末の位置変動が描く円弧の回転軸となる。この曲線の変動は、携帯端末に搭載された加速度センサ又は地磁気センサによって検出される。即ち、その回転軸とその円弧とからなる平面（扇形）は、加速度面（加速度ベクトル群の成す面）として表される。携帯端末が手持ちで振られる限り、この加速度面は、進行方向と平行になる。
【００２４】
また、加速度センサから出力された加速度データを二乗和の平方根（√(ｘ2＋ｙ2＋ｚ2)）を求めることによって、合成加速度が得られる。図１によれば、歩行者に把持された携帯端末の位置として、位置Ａ、位置Ｂ及び位置Ｃが表されている。位置Ｂは、歩行者の手が真下にある時（最下点）であり、手持ちされた携帯端末の合成加速度は、極大（最大）となる。逆に、位置Ａ及び位置Ｃは、歩行者の手が最も高い位置にある時（最上点）であり、その合成加速度は、極小（最小）となる。従って、合成加速度が極大となった時の携帯端末の位置は、重力方向を表すこととなる。これによって、加速度データによって、腕振り方向に基づく加速度面と、重力方向とを導出することができる。
【００２５】
更に、歩行者及び携帯端末に対しては、地磁気が到来している。歩行者が、端末を一定の姿勢で保持し、一方向に真っ直ぐ進行している限り、その地磁気のセンサ座標系における到来方向は同じである。しかしながら、歩行者は、手持ちにした携帯端末を前後に振るために、その腕振りに応じて、地磁気の到来方向が、曲線を描いて変動する。この曲線の変動は、携帯端末に搭載された地磁気センサによって検出される。
【００２６】
図２は、現実に発生する加速度面及び方位基準面を表す図である。簡単化のために、重力方向を図の下方向としているが、重力そのものを検出することはできない。また、実際に、地磁気が、センサ座標系に対してどの方向に検出されるかは、端末の姿勢に依存する。但し、加速度面と方位基準面の関係については、端末の姿勢には依存しない。
【００２７】
図２によれば、加速度センサから得られた３軸の加速度データ（ｘ、ｙ、ｚ）と、地磁気センサから得られた３軸の地磁気データ（ｘ、ｙ、ｚ）とが、３次元座標系にプロットされたものである。異なる端末位置において測定された加速度データのプロットから、加速度面を検出できる。また、あるタイミングにおける加速度ベクトルと地磁気ベクトルの組から、方位基準面を検出することができる。
【００２８】
また、図２によれば、歩行者は、南から到来している地磁気に対して、方向角θの方向へ歩行している。このとき、携帯端末を手持ちした歩行者による腕振り動作に応じて、進行方向に平行に加速度面が検出でき、南北方向に平行に方位基準面が検出できる。
【００２９】
本発明によれば、複数の加速度データを平面に近似することによって、方向角θを算出することができる。
【００３０】
加速度面を近似的に算出する方法としては、例えば、最小二乗法がある。最小二乗法は、残差の２乗の和が最小になるように、その現象に対し、予測関数ｆ(ｘ)のそれぞれの係数を決定する方法である。残差とは、ｉ番目のデータｎｉに対して予測された関数値ｆ(ｎｉ)と、測定されたデータｍｉとの差、即ちｍｉ−ｆ(ｎｉ)である。
【００３１】
一般に原点を通る平面は、以下の式（１）によって表される。
ａｘ＋ｂｙ＋ｃｚ＝０                                            式（１）
このとき、（ａ，ｂ，ｃ）は、平面に対する法線ベクトルとなる。
【００３２】
ここで、計算を単純化するために、式（１）を、式（２）のように変形する。
ｚ＝αｘ＋βｙ                                                  式（２）
尚、（ａ，ｂ，ｃ）は法線ベクトルであるため、ｃ＝−１として問題無い。
【００３３】
ｎ個の点群ｘｉ，ｙｉ，ｚｉ（ｉ＝１〜ｎ）が与えられたとき、以下の式（３）が最小となるα及びβを算出すればよい。
Ｓ＝Σi=1n(ｚｉ−αｘｉ−βｙｉ)２                              式（３）
【００３４】
ここで、以下のように規定したとする。
Ａ＝Σi=1n(ｘｉ２)
Ｂ＝Σi=1n(ｙｉ２)
Ｃ＝Σi=1n(ｚｉ２)
Ｄ＝Σi=1n(ｘｉ×ｙｉ)
Ｅ＝Σi=1n(ｘｉ×ｚｉ)
Ｆ＝Σi=1n(ｙｉ×ｚｉ)
【００３５】
このとき、式（３）は、以下のような式（４）になる。
Ｓ＝Ａα２＋Ｂβ２＋Ｃ＋２αβＤ−２αＥ−２βＦ                式（４）
【００３６】
式（４）をαの関数とみたとき、凹型の２次関数となり、極小値が最小となる。これは、βにおいても同様である。即ち、Ｓをα、βに関して偏微分し、０となる点が求める解となる。
【数１】
0005072100.tif 000002
【００３７】
式（５）及び式（６）を解くと、以下の式（７）及び式（８）のように算出できる。
α＝（ＢＥ−ＤＦ）／（ＡＢ−Ｄ２）                              式（７）
β＝（ＡＦ−ＤＥ）／（ＡＢ−Ｄ２）                              式（８）
前述したように、法線ベクトルは（α，β，−１）である。
【００３８】
以下の表１によれば、時間経過ｐ１〜ｐ９に基づいて、観測された加速度データｘ，ｙ，ｚが表されている。
【表１】
0005072100.tif 000003
【００３９】
【表２】
0005072100.tif 000004
【００４０】
表１及び表２によれば、α及びβは、以下のように算出される。
α＝  0.012705529
β＝−0.014162858
【００４１】
加速度面の法線ベクトルｎａ＝（αａ，βａ，−１）
【００４２】
方位基準面は、加速度ベクトルと地磁気ベクトルの外積を法線ベクトルとした平面である。一般に、２つのベクトルａ＝（ｘａ，ｙａ，ｚａ）、ｂ＝（ｘｂ，ｙｂ，ｚｂ）の外積は、次の式で求められる。
ａ×ｂ＝（ｙａｚｂ−ｙｂｚａ，ｚａｘｂ−ｚｂｘａ，ｘａｙｂ−ｘｂｙａ）式（９）
従って、
加速度ベクトルａ０＝（ｘａ，ｙａ，ｚａ）、地磁気ベクトルｍ０＝（ｘｍ，ｙｍ，ｚｍ）としたとき、方位基準面の法線ベクトルｎ０＝（ｘｎ，ｙｎ，ｚｎ）は、
ｎ０＝ａ０×ｍ０
＝（ｙａｚｍ−ｙｍｚａ，ｚａｘｍ−ｚｍｘａ，ｘａｙｍ−ｘｍｙａ）式（１０）
で表される。
【００４３】
【表３】
0005072100.tif 000005
【００４４】
表３によれば、方位基準面の法線ベクトルは、以下のように算出される。
ｎ０＝（−7977，−31222，−158899）
【００４５】
方向角θを算出するため、加速度面及び方位基準面の２つの平面それぞれについて、前述したように法線ベクトルを算出する。最初に、各法線ベクトルを以下のように定義する。
加速度面の法線ベクトルｎａ＝（αａ，βａ，−１）
方位基準面の法線ベクトルｎ０＝（ｘｎ，ｙｎ，ｚｎ）
ｎａ・ｎ０：２つの法線ベクトルの内積（スカラー積）
｜ｎａ｜：加速度面の法線ベクトルｎａの大きさ（線分の長さ）
｜ｎ０｜：方位基準面の法線ベクトルｎ０の大きさ（線分の長さ）
｜ｎａ｜｜ｎ０｜：２つの法線ベクトルの大きさの積
【００４６】
表１〜表３によれば、ｎａ及びｎ０は、以下のようになる。
ｎａ＝（0.012705529，−0.014162858，−１）
｜ｎａ｜＝1.000180992
ｎ０＝（−7977，−31222，−158899）
｜ｎ０｜＝162133.7041
【００４７】
このとき、ベクトルの成す角と内積の関係より、以下のように方向角θを算出することができる。
ｎａ・ｎ０＝｜ｎａ｜｜ｎ０｜ｃｏｓθ                            式（１１）
ｃｏｓθ＝（ｎａ・ｎ０）／（｜ｎａ｜｜ｎ０｜）                  式（１２）
θ＝ａｒｃｃｏｓ（（ｎａ・ｎ０）／（｜ｎａ｜｜ｎ０｜））        式（１３）
【００４８】
表１〜表３によれば、前述の式に当てはめて、方向角θを算出する。
ｎａ・ｎ０＝0.012705529×（−7977）+（−0.014162858）×（−31222）
＋（−１）×（−１）
＝159239.8407
｜ｎａ｜｜ｎ０｜＝1.000180992×162133.7041
＝162163.0490033724672
ｎａ・ｎ０＝｜ｎａ｜｜ｎ０｜ｃｏｓθ                      式（１１）
159239.8407＝162163.0490033724672・ｃｏｓθ
ｃｏｓθ＝（ｎａ・ｎ０）／（｜ｎａ｜｜ｎ０｜）            式（１２）
＝159239.8407／162163.0490033724672
＝0.981973647
θ＝ａｒｃｃｏｓ（（ｎａ・ｎ０）／（｜ｎａ｜｜ｎ０｜））  式（１３）
＝ａｒｃｃｏｓ（0.981973647）
＝0.190161893 [rad]
＝10.89547387 [deg]
【００４９】
図３は、方向角θの向きを表す説明図である。北を１２時方向として鉛直真上方向から見た図である。
【００５０】
前述した計算により加速度面と方位基準面の法線ベクトルから数学的に求められる方向角θは、０°〜１８０°である。一方、実際の方位角θというと、北から時計回りを正方向として０°〜３６０°である。
【００５１】
方向角θは、南北方向に対する進行方向の成す角である。進行方向は、無向直線であり前後の区別が無い。図３（ａ）及び（ｂ）によれば、南北方向を境界として左右（東西）対称となる２通りの位置に対して、同一の方向角θが得られる。例えば、方位角として、３０°（北東方向）及び３３０°（北西方向）の２通りの場合に、加速度面及び方位基準面から算出される方向角θは、３０°で同一である。このとき、北を０度とした時計回りの方位角（０〜３６０°）を導出するために、加速度面の前方（又は後方）を決定する必要がある（尚、この決定は、後述する図４の前方決定部１０７によって実現される）。
【００５２】
加速度面の前方は、合成加速度の連続するピーク点のうち大きい方に特定することができる。歩行により発生する加速度の大きさは、体の左右で対称であるが、携帯端末は、片手（体の中央から左右どちらかに偏った位置）で保持するため、左右非対称に検出される。例えば、歩行者が、右手に携帯端末を把持している場合に、右足で地面を蹴った際の加速度の大きさと、左足で地面を蹴った際の加速度の大きさとは、異なって検出される。この場合、右足で地面を蹴った際の加速度は、左足で地面を蹴った際の加速度よりも大きい。通常、人間の歩行は、手と足とが連動しており、例えば右手が前に出ている時に、右足が地面を蹴り出している。そのために、携帯端末を把持した側の足で地面を蹴ったと判断できれば、そのときの携帯端末は、前方に位置していると判断できる。
【００５３】
図４は、本発明の携帯端末における機能構成図である。
【００５４】
図４によれば、携帯端末１は、マイクロプロセッサ部１０と、地磁気センサ１１と、加速度センサ１２と、ＧＰＳ部１３と、地図情報記憶部１４と、ディスプレイ部１５とを有する。
【００５５】
地磁気センサ１１は、３軸方向（前後方向、左右方向及び上下方向）の地磁気の方向を測定する。地磁気センサ１１は、ホール素子を分離し、分離したホール素子からそれぞれ検出された値を出力する。
【００５６】
加速度センサ１２は、加速度、即ち単位時間当たりの速度の変化を検出する。携帯端末の傾きを検出することができる３軸タイプの場合、３次元の加速度を検出でき、地球の重力（静的加速度）の計測にも対応できる。
【００５７】
ＧＰＳ部１３は、基準の現在位置となる緯度経度情報を測位する。測位された現在位置を基準点として、歩行者の現在位置を、歩数、歩幅及び進行方向によって積算することができる。
【００５８】
地図情報記憶部１４は、例えば道路地図のような走行経路を表す地図情報を記憶する。また、ディスプレイ部１５は、マイクロプロセッサ部１０から出力された進行方向及び現在位置を、地図情報と共に表示する。これにより、歩行者に対してナビゲーション機能を提供する。
【００５９】
マイクロプロセッサ部１０は、歩行タイミング決定部１０１と、進行方向決定部１０２と、方向転換判定部１０３と、歩幅決定部１０４と、移動量積算部１０５と、現在位置決定部１０６と、前方決定部１０７として機能するようなプログラムを実行する。
【００６０】
歩行タイミング決定部１０１は、加速度センサ１２から出力された加速度データ列を、所定時間毎、例えば歩数毎、又は歩数に基づく時間単位毎の、加速度データに分割する。例えば、合成加速度の変化、即ち移動時の揺れ具合から歩数を算出することもできる。
【００６１】
進行方向決定部１０２は、所定時間毎に、地磁気センサ１１からの地磁気データと、加速度センサ１２からの加速度データと、歩行タイミング決定部１０１からの歩行タイミングデータから、進行方向を決定する。本発明は、この進行方向決定部１０２における進行方向の特定方法に基づく。
【００６２】
前方決定部１０７は、加速度センサ１２から出力された加速度データ列から、歩行者の歩行の向き、即ち、加速度面の前方を決定する。加速度面の前方は、合成加速度の大きさによって特定することができる。例えば、携帯端末を把持した側の足で地面を蹴ったとき、加速度が大きくなり、その携帯端末は前方に位置していると判断できる。
【００６３】
方向転換判定部１０３は、進行方向決定部１０２から進行方向のデータを受け取り、前方決定部１０７から前方の向きのデータを受け取る。方向転換判定部１０３は、メモリを有し、進行方向及び向きのデータを時間経過に応じて記憶する。そして、方向転換判定部１０３は、メモリに記憶された一定の時間範囲の進行方向について、方向転換がなされたか否かを判定する。
【００６４】
歩幅決定部１０４は、歩行タイミング決定部１０１から１歩分の加速度データを受け取り、１歩毎の歩幅を決定する。決定された歩幅は、移動量積算部１０５へ出力される。尚、歩幅決定部１０４は、その歩幅の情報を方向転換判定部１０３にも出力する。
【００６５】
移動量積算部１０５は、進行方向決定部１０２から進行方向の情報を受け取り、歩幅決定部１０４から歩幅の情報を受け取る。そして、移動量積算部１０５は、１歩分の進行方向及び歩幅を積算する。現在位置決定部１０６は、地図情報記憶部１４から地図情報を取得し、積算された移動量から現在位置を特定する。現在位置決定部１０６は、方向転換判定部１０３が方向転換したと判定すれば、地図情報における近傍の交差点の位置を現在位置として決定する。また、方向転換していないと判定すれば（直進したと判定すれば）、マップマッチングによって投影された位置を、現在位置として決定する。
【００６６】
本発明の特徴となる進行方向決定部１０２は、フィルタ部１０２１と、基準ベクトル導出部１０２２と、方位基準面算出部１０２３と、加速度面算出部１０２４と、方向角算出部１０２５と、補正部１０２６とを有する。フィルタ部１０２１及び補正部１０２６は、本発明について本質的な機能では無いが、これによって進行方向の精度を向上させることができる。
【００６７】
基準ベクトル導出部１０２２は、複数の加速度データから重力方向の重力ベクトルを導出し、且つ、その重力ベクトルに対応する地磁気ベクトルを選択する。
【００６８】
方位基準面算出部１０２３は、基準ベクトル導出部１０２２によって得られた１組の加速度ベクトル及び地磁気ベクトルから構成される方位基準面を算出する。方位基準面は、１組の加速度ベクトル及び地磁気ベクトルの外積から得られる。
【００６９】
加速度面算出部１０２４は、単位区間中の複数の加速度ベクトル群を、例えば最小二乗法など既知の方法を用いて、平面に近似する。
【００７０】
方向角算出部１０２５は、方位基準面算出部１０２３によって算出された方位基準面及び加速度面算出部１０２４によって算出された加速度面の両平面の法線ベクトルの間の角度から方向角θを算出する。加速度面と方位基準面の位置関係は、腕振り方向、即ち歩行者の進行方向によって変化する。
【００７１】
フィルタ部１０２１は、基準ベクトル導出部１０２２に入力される加速度データ及び地磁気データについて、所定時間範囲のデータをメモリし、最大値及び最小値から所定割合のデータを除去する。即ち、突飛なデータを除去することができる。
【００７２】
補正部１０２６は、方向角算出部１０２５から出力された方向角θについて、所定時間範囲の方向角θをメモリし、当該方向角θの前後の変化が所定角度閾値以上となっている方向角θを除去する。
【００７３】
例えば、以下の表４のように、１つのデータだけが前後のデータよりも突飛な値、例えば９０°（所定角度閾値）以上振れていた場合、そのデータを除去する。
【表４】
0005072100.tif 000006
【００７４】
また、補正部１０２６は、除去されたデータについて、以下の表５のように、時間的に前後に算出された単位区間の方向角θの平均によって補完することも好ましい。
【表５】
0005072100.tif 000007
【００７５】
更に、補正部１０２６は、蓄積した複数の方向角θの変化が、平均化することも好ましい。以下の表６によれば、一定範囲の方向角θ毎に、平均化したものである。
【表６】
0005072100.tif 000008
【００７６】
以上、詳細に説明したように、本発明の携帯端末、プログラム及び方法によれば、歩行者が、携帯端末を手持ちで歩行している場合であっても、その携帯端末に搭載された加速度センサ及び地磁気センサを用いて、歩行者の進行方向をできる限り正確に決定することができる。
【００７７】
前述した本発明における種々の実施形態によれば、当業者は、本発明の技術思想及び見地の範囲における種々の変更、修正及び省略を容易に行うことができる。前述の説明はあくまで例であって、何ら制約しようとするものではない。本発明は、特許請求の範囲及びその均等物として限定するものにのみ制約される。
【図面の簡単な説明】
【００７８】
【図１】歩行者の歩行態様と、加速度変動方向及び地磁気変動方向とを表す説明図である。
【図２】現実に発生する加速度面及び方位基準面を表す図である。
【図３】方向角θの向きを表す説明図である。
【図４】本発明の携帯端末における機能構成図である。
【符号の説明】
【００７９】
１  携帯端末
１０  マイクロプロセッサ部
１０１  歩行タイミング決定部
１０２  進行方向決定部
１０２１  フィルタ部
１０２２  基準ベクトル導出部
１０２３  座標系変換行列算出部
１０２４  座標系変換部
１０２５  方向角算出部
１０２５  補正部
１０３  方向転換判定部
１０４  歩幅決定部
１０５  移動量積算部
１０６  現在位置決定部
１０７  前方決定部
１１  地磁気センサ
１２  加速度センサ
１３  ＧＰＳ部
１４  地図情報記憶部
１５  ディスプレイ部
【図１】
0005072100.tif 000009
【図２】
0005072100.tif 000010
【図３】
0005072100.tif 000011
【図４】
0005072100.tif 000012