説明

加速度センサ及び地磁気センサを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法

【課題】歩行者が、携帯端末を手持ちで歩行している場合であっても、その携帯端末に搭載された地磁気センサのみを用いて、歩行者の進行方向をできる限り正確に決定する携帯端末、プログラム及び方法を提供する。
【解決手段】携帯端末の進行方向決定手段は、複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する基準ベクトル導出手段と、記重力ベクトルと地磁気ベクトルからなる方位基準面の法線ベクトルを導出する方位基準面導出手段と、複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する加速度面算出手段と、方位基準面と加速度面の両平面の法線ベクトルのなす角を方向角として算出する方向角算出手段とを有する。

【発明の詳細な説明】
【技術分野】
【0001】
本発明は、加速度センサ及び地磁気センサを用いて歩行者の進行方向を決定する携帯端末、プログラム及び方法に関する。特に、進行方向及び現在位置をリアルタイムに導出する自律航法技術に関する。
【背景技術】
【0002】
従来、加速度センサ及び方位センサを用いて、進行方向及び現在位置をリアルタイムに導出する自律航法技術がある。自律航法技術は、GPS(Global Positioning System)技術と組み合わされて、主にカーナビゲーションシステム(Car Navigation System)に利用されている。カーナビゲーションシステムは、自動車の運転者に対して、正確な進行方向及び現在位置と、目的地への走行経路案内とを、ディスプレイに表示する。
【0003】
カーナビゲーションシステムは、GPSによって測位した現在位置情報を、車速パルス又はジャイロのような自律航法技術によって補正する。また、道路地図情報を必要に応じて読み出し、現在の走行経路が道路上と一致するように、進行方向及び現在位置を補正する(投影法によるマップマッチング技術、例えば特許文献1参照)。これにより、センサの誤差によって、現在位置が、道路上でない位置になることを防ぐことができる。
【0004】
これに対し、このようなナビゲーション技術を、歩行者の所持する携帯端末に適応したシステムもある。具体的には、検出した歩行者の「歩数」と、その歩行者の「歩幅」とを用いて、始点からの累積的な現在位置を導出する(例えば特許文献2参照)。自律航法技術を歩行者に適応した場合、水平方向の移動以外の加速度成分も検出される。従って、測定される距離は、単純に加速度センサの出力を積分するのではなく、歩数及び歩幅から導出される。
【0005】
「歩数」は、携帯端末内の加速度センサによって検出された軸毎の加速度を二乗和の平方根とし(√(x2+y2+z2))、そのピーク−ピーク間を1歩として検出する(例えば特許文献3参照)。「歩幅」は、利用者が予め設定するか、若しくは利用者の身長から推定する。又は、他の技術によれば、歩行者に規定距離を歩行させることによって、その歩幅をキャリブレーションする技術もある(例えば非特許文献1参照)。
【0006】
「進行方向」は、「方位センサ」によって検出される。方位センサとしては、一般に地磁気センサが利用される。地磁気センサを用いて検出した端末の姿勢及び方向を、ディスプレイに3次元表示する技術もある(例えば特許文献4参照)。また、進行方向に交差点を介して複数の道路が存在する場合、その交差点を、現在位置とする技術もある(例えば特許文献5参照)。
【0007】
自律航法技術を用いた現在位置の決定について、センサデータの累積的誤差の影響を防ぐために、交差点での右折左折を検出した際に、その交差点を、現在位置の特定のための始点とする技術もある(例えば特許文献6参照)。即ち、方向転換が検出される毎に、センサデータの累積的誤差がリセットされることなり、その後の現在位置の特定に、先の累積的誤差が影響しない。
【0008】
【特許文献1】特開平5−061408号公報
【特許文献2】特開平9−089584号公報
【特許文献3】特開2005−038018号公報
【特許文献4】特開2004−046006号公報
【特許文献5】特開平3−099399号公報
【特許文献6】特開昭63−011813号公報
【非特許文献1】「Nike+iPodユーザーズガイド」、第27頁、「online」、[平成20年3月25日検索]、インターネット<URL:http://manuals.info.apple.com/ja/nikeipod_users_guide.pdf>
【発明の開示】
【発明が解決しようとする課題】
【0009】
特許文献4に記載された技術によれば、加速度センサ及び地磁気センサを用いて静止状態における方位を導出することができる。静止状態では、加速度センサによって検出される加速度ベクトルは、重力のみを表す。従って、その重力ベクトルとその地磁気ベクトルとを用いて導出される世界座標系から、方位を導出することができる。
【0010】
しかしながら、実際に、歩行者に所持された携帯端末によって方位を導出する場合、手持ち状態のためにセンサによって検出される波形が乱れ、正しい方位を導出することはできない。特に、歩行時に生じる加速度ベクトルは、重力の他に、運動加速度や腕振り運動による遠心力などが合成されたものである。従って、重力方向を決定できないために世界座標系も導出できず、結局、方位を導出することもできない。また、歩行者が手持ちするような携帯端末については、サイズやコストの制約から、カーナビゲーションシステムに搭載されるジャイロセンサを用いることも難しい。
【0011】
そこで、本発明は、歩行者が、携帯端末を手持ちで歩行している場合であっても、その携帯端末に搭載された加速度センサ及び地磁気センサを用いて、歩行者の進行方向をできる限り正確に決定する携帯端末、プログラム及び方法を提供することを目的とする。
【課題を解決するための手段】
【0012】
本発明によれば、3軸の加速度データを出力する加速度センサと、3軸の地磁気データを出力する地磁気センサと、加速度データ及び地磁気データから歩行者の進行方向を決定する進行方向決定手段とを有し、歩行者によって所持される携帯端末であって、
進行方向決定手段は、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する基準ベクトル導出手段と、
重力ベクトルと地磁気ベクトルからなる方位基準面の法線ベクトルを導出する方位基準面導出手段と、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する加速度面算出手段と、
方位基準面の法線ベクトルと加速度面の法線ベクトルとのなす角を方向角として算出する方向角算出手段と
を有することを特徴とする。
【0013】
本発明の携帯端末における他の実施形態によれば、
加速度センサから入力された加速度データを、歩数毎、又は歩数に基づく時間単位毎に区分し、進行方向決定手段へ出力する歩行タイミング決定手段と、
進行方向決定手段から出力された、歩数毎、又は歩数に基づく時間単位毎の進行方向について、方向転換がなされたか否かを判定する方向転換判定手段と
を更に有することも好ましい。
【0014】
本発明の携帯端末における他の実施形態によれば、
歩行者の歩行の向き、即ち、加速度面の前方を決定する前方決定手段を更に有し、
前方決定手段は、加速度センサから出力された加速度データ列における合成加速度の連続するピーク点のうち大きい方を、加速度面の前方として決定し、その旨を方向転換判定手段へ通知することも好ましい。
【0015】
本発明の携帯端末における他の実施形態によれば、
基準ベクトル導出手段に入力される加速度データ及び地磁気データについて、
所定時間範囲のデータをメモリし、最大値及び最小値から所定割合のデータを除去するフィルタ手段を更に有することも好ましい。
【0016】
本発明の携帯端末における他の実施形態によれば、
方向角算出手段から出力された方向角θについて、
所定時間範囲の方向角θをメモリし、当該方向角θの前後の変化が所定角度閾値以上となっている方向角θを除去する補正手段を更に有することも好ましい。
【0017】
本発明によれば、3軸の加速度データを出力する加速度センサと、3軸の地磁気データを出力する地磁気センサとを有し、歩行者によって所持される携帯端末に搭載されたコンピュータを、加速度データ及び地磁気データから歩行者の進行方向を決定する進行方向決定手段として機能させる携帯端末用のプログラムであって、
進行方向決定手段は、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する基準ベクトル導出手段と、
重力ベクトルと地磁気ベクトルからなる方位基準面の法線ベクトルを導出する方位基準面導出手段と、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する加速度面算出手段と、
方位基準面と加速度面の両平面の法線ベクトルのなす角を方向角として算出する方向角算出手段と
してコンピュータを機能させることを特徴とする。
【0018】
本発明によれば、3軸の加速度データを出力する加速度センサと、3軸の地磁気データを出力する地磁気センサとを有し、歩行者によって所持される携帯端末について、加速度データ及び地磁気データから歩行者の進行方向を決定する進行方向決定方法であって、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する第1のステップと、
重力ベクトルと重力ベクトルに対応する地磁気ベクトルの法線ベクトルを導出する第2のステップと、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する第3のステップと、
方位基準面と加速度面の法線ベクトルのなす角を方向角として算出する第4のステップと
を有することを特徴とする。
【発明の効果】
【0019】
本発明の携帯端末、プログラム及び方法によれば、加速度データ群の軌跡と北方位との方向角を算出できるので、歩行者が、携帯端末を手持ちで歩行している場合であっても、その携帯端末に搭載された加速度センサ及び地磁気センサを用いて、歩行者の進行方向をできる限り正確に決定することができる。
【発明を実施するための最良の形態】
【0020】
以下では、図面を用いて、本発明を実施するための最良の形態について詳細に説明する。
【0021】
図1は、歩行者の歩行態様と、加速度変動方向及び地磁気変動方向とを表す説明図である。
【0022】
図1によれば、歩行者は、携帯端末を手持ちにし、その手を前後に振りながら歩行している。このような一般的な歩行態様を横方向から見れば、携帯端末の位置は、円弧を描きながら振り子状に前後に変動している。また、進行方向から見れば、携帯端末の位置は、上下に変動している。
【0023】
携帯端末を手持ちした腕における肩部分は、携帯端末の位置変動が描く円弧の回転軸となる。この曲線の変動は、携帯端末に搭載された加速度センサ又は地磁気センサによって検出される。即ち、その回転軸とその円弧とからなる平面(扇形)は、加速度面(加速度ベクトル群の成す面)として表される。携帯端末が手持ちで振られる限り、この加速度面は、進行方向と平行になる。
【0024】
また、加速度センサから出力された加速度データを二乗和の平方根(√(x2+y2+z2))を求めることによって、合成加速度が得られる。図1によれば、歩行者に把持された携帯端末の位置として、位置A、位置B及び位置Cが表されている。位置Bは、歩行者の手が真下にある時(最下点)であり、手持ちされた携帯端末の合成加速度は、極大(最大)となる。逆に、位置A及び位置Cは、歩行者の手が最も高い位置にある時(最上点)であり、その合成加速度は、極小(最小)となる。従って、合成加速度が極大となった時の携帯端末の位置は、重力方向を表すこととなる。これによって、加速度データによって、腕振り方向に基づく加速度面と、重力方向とを導出することができる。
【0025】
更に、歩行者及び携帯端末に対しては、地磁気が到来している。歩行者が、端末を一定の姿勢で保持し、一方向に真っ直ぐ進行している限り、その地磁気のセンサ座標系における到来方向は同じである。しかしながら、歩行者は、手持ちにした携帯端末を前後に振るために、その腕振りに応じて、地磁気の到来方向が、曲線を描いて変動する。この曲線の変動は、携帯端末に搭載された地磁気センサによって検出される。
【0026】
図2は、現実に発生する加速度面及び方位基準面を表す図である。簡単化のために、重力方向を図の下方向としているが、重力そのものを検出することはできない。また、実際に、地磁気が、センサ座標系に対してどの方向に検出されるかは、端末の姿勢に依存する。但し、加速度面と方位基準面の関係については、端末の姿勢には依存しない。
【0027】
図2によれば、加速度センサから得られた3軸の加速度データ(x、y、z)と、地磁気センサから得られた3軸の地磁気データ(x、y、z)とが、3次元座標系にプロットされたものである。異なる端末位置において測定された加速度データのプロットから、加速度面を検出できる。また、あるタイミングにおける加速度ベクトルと地磁気ベクトルの組から、方位基準面を検出することができる。
【0028】
また、図2によれば、歩行者は、南から到来している地磁気に対して、方向角θの方向へ歩行している。このとき、携帯端末を手持ちした歩行者による腕振り動作に応じて、進行方向に平行に加速度面が検出でき、南北方向に平行に方位基準面が検出できる。
【0029】
本発明によれば、複数の加速度データを平面に近似することによって、方向角θを算出することができる。
【0030】
加速度面を近似的に算出する方法としては、例えば、最小二乗法がある。最小二乗法は、残差の2乗の和が最小になるように、その現象に対し、予測関数f(x)のそれぞれの係数を決定する方法である。残差とは、i番目のデータnに対して予測された関数値f(n)と、測定されたデータmとの差、即ちm−f(n)である。
【0031】
一般に原点を通る平面は、以下の式(1)によって表される。
ax+by+cz=0 式(1)
このとき、(a,b,c)は、平面に対する法線ベクトルとなる。
【0032】
ここで、計算を単純化するために、式(1)を、式(2)のように変形する。
z=αx+βy 式(2)
尚、(a,b,c)は法線ベクトルであるため、c=−1として問題無い。
【0033】
n個の点群x,y,z(i=1〜n)が与えられたとき、以下の式(3)が最小となるα及びβを算出すればよい。
S=Σi=1n(z−αx−βy) 式(3)
【0034】
ここで、以下のように規定したとする。
A=Σi=1n(x)
B=Σi=1n(y)
C=Σi=1n(z)
D=Σi=1n(x×y)
E=Σi=1n(x×z)
F=Σi=1n(y×z)
【0035】
このとき、式(3)は、以下のような式(4)になる。
S=Aα+Bβ+C+2αβD−2αE−2βF 式(4)
【0036】
式(4)をαの関数とみたとき、凹型の2次関数となり、極小値が最小となる。これは、βにおいても同様である。即ち、Sをα、βに関して偏微分し、0となる点が求める解となる。
【数1】

【0037】
式(5)及び式(6)を解くと、以下の式(7)及び式(8)のように算出できる。
α=(BE−DF)/(AB−D) 式(7)
β=(AF−DE)/(AB−D) 式(8)
前述したように、法線ベクトルは(α,β,−1)である。
【0038】
以下の表1によれば、時間経過p1〜p9に基づいて、観測された加速度データx,y,zが表されている。
【表1】

【0039】
【表2】

【0040】
表1及び表2によれば、α及びβは、以下のように算出される。
α= 0.012705529
β=−0.014162858
【0041】
加速度面の法線ベクトルn=(α,β,−1)
【0042】
方位基準面は、加速度ベクトルと地磁気ベクトルの外積を法線ベクトルとした平面である。一般に、2つのベクトルa=(x,y,z)、b=(x,y,z)の外積は、次の式で求められる。
a×b=(y−y,z−z,x−x)式(9)
従って、
加速度ベクトルa=(x,y,z)、地磁気ベクトルm=(x,y,z)としたとき、方位基準面の法線ベクトルn=(x,y,z)は、
=a×m
=(y−y,z−z,x−x)式(10)
で表される。
【0043】
【表3】

【0044】
表3によれば、方位基準面の法線ベクトルは、以下のように算出される。
=(−7977,−31222,−158899)
【0045】
方向角θを算出するため、加速度面及び方位基準面の2つの平面それぞれについて、前述したように法線ベクトルを算出する。最初に、各法線ベクトルを以下のように定義する。
加速度面の法線ベクトルn=(α,β,−1)
方位基準面の法線ベクトルn=(x,y,z
・n:2つの法線ベクトルの内積(スカラー積)
|n|:加速度面の法線ベクトルnの大きさ(線分の長さ)
|n|:方位基準面の法線ベクトルnの大きさ(線分の長さ)
|n||n|:2つの法線ベクトルの大きさの積
【0046】
表1〜表3によれば、n及びnは、以下のようになる。
=(0.012705529,−0.014162858,−1)
|n|=1.000180992
=(−7977,−31222,−158899)
|n|=162133.7041
【0047】
このとき、ベクトルの成す角と内積の関係より、以下のように方向角θを算出することができる。
・n=|n||n|cosθ 式(11)
cosθ=(n・n)/(|n||n|) 式(12)
θ=arccos((n・n)/(|n||n|)) 式(13)
【0048】
表1〜表3によれば、前述の式に当てはめて、方向角θを算出する。
・n=0.012705529×(−7977)+(−0.014162858)×(−31222)
+(−1)×(−1)
=159239.8407
|n||n|=1.000180992×162133.7041
=162163.0490033724672
・n=|n||n|cosθ 式(11)
159239.8407=162163.0490033724672・cosθ
cosθ=(n・n)/(|n||n|) 式(12)
=159239.8407/162163.0490033724672
=0.981973647
θ=arccos((n・n)/(|n||n|)) 式(13)
=arccos(0.981973647)
=0.190161893 [rad]
=10.89547387 [deg]
【0049】
図3は、方向角θの向きを表す説明図である。北を12時方向として鉛直真上方向から見た図である。
【0050】
前述した計算により加速度面と方位基準面の法線ベクトルから数学的に求められる方向角θは、0°〜180°である。一方、実際の方位角θというと、北から時計回りを正方向として0°〜360°である。
【0051】
方向角θは、南北方向に対する進行方向の成す角である。進行方向は、無向直線であり前後の区別が無い。図3(a)及び(b)によれば、南北方向を境界として左右(東西)対称となる2通りの位置に対して、同一の方向角θが得られる。例えば、方位角として、30°(北東方向)及び330°(北西方向)の2通りの場合に、加速度面及び方位基準面から算出される方向角θは、30°で同一である。このとき、北を0度とした時計回りの方位角(0〜360°)を導出するために、加速度面の前方(又は後方)を決定する必要がある(尚、この決定は、後述する図4の前方決定部107によって実現される)。
【0052】
加速度面の前方は、合成加速度の連続するピーク点のうち大きい方に特定することができる。歩行により発生する加速度の大きさは、体の左右で対称であるが、携帯端末は、片手(体の中央から左右どちらかに偏った位置)で保持するため、左右非対称に検出される。例えば、歩行者が、右手に携帯端末を把持している場合に、右足で地面を蹴った際の加速度の大きさと、左足で地面を蹴った際の加速度の大きさとは、異なって検出される。この場合、右足で地面を蹴った際の加速度は、左足で地面を蹴った際の加速度よりも大きい。通常、人間の歩行は、手と足とが連動しており、例えば右手が前に出ている時に、右足が地面を蹴り出している。そのために、携帯端末を把持した側の足で地面を蹴ったと判断できれば、そのときの携帯端末は、前方に位置していると判断できる。
【0053】
図4は、本発明の携帯端末における機能構成図である。
【0054】
図4によれば、携帯端末1は、マイクロプロセッサ部10と、地磁気センサ11と、加速度センサ12と、GPS部13と、地図情報記憶部14と、ディスプレイ部15とを有する。
【0055】
地磁気センサ11は、3軸方向(前後方向、左右方向及び上下方向)の地磁気の方向を測定する。地磁気センサ11は、ホール素子を分離し、分離したホール素子からそれぞれ検出された値を出力する。
【0056】
加速度センサ12は、加速度、即ち単位時間当たりの速度の変化を検出する。携帯端末の傾きを検出することができる3軸タイプの場合、3次元の加速度を検出でき、地球の重力(静的加速度)の計測にも対応できる。
【0057】
GPS部13は、基準の現在位置となる緯度経度情報を測位する。測位された現在位置を基準点として、歩行者の現在位置を、歩数、歩幅及び進行方向によって積算することができる。
【0058】
地図情報記憶部14は、例えば道路地図のような走行経路を表す地図情報を記憶する。また、ディスプレイ部15は、マイクロプロセッサ部10から出力された進行方向及び現在位置を、地図情報と共に表示する。これにより、歩行者に対してナビゲーション機能を提供する。
【0059】
マイクロプロセッサ部10は、歩行タイミング決定部101と、進行方向決定部102と、方向転換判定部103と、歩幅決定部104と、移動量積算部105と、現在位置決定部106と、前方決定部107として機能するようなプログラムを実行する。
【0060】
歩行タイミング決定部101は、加速度センサ12から出力された加速度データ列を、所定時間毎、例えば歩数毎、又は歩数に基づく時間単位毎の、加速度データに分割する。例えば、合成加速度の変化、即ち移動時の揺れ具合から歩数を算出することもできる。
【0061】
進行方向決定部102は、所定時間毎に、地磁気センサ11からの地磁気データと、加速度センサ12からの加速度データと、歩行タイミング決定部101からの歩行タイミングデータから、進行方向を決定する。本発明は、この進行方向決定部102における進行方向の特定方法に基づく。
【0062】
前方決定部107は、加速度センサ12から出力された加速度データ列から、歩行者の歩行の向き、即ち、加速度面の前方を決定する。加速度面の前方は、合成加速度の大きさによって特定することができる。例えば、携帯端末を把持した側の足で地面を蹴ったとき、加速度が大きくなり、その携帯端末は前方に位置していると判断できる。
【0063】
方向転換判定部103は、進行方向決定部102から進行方向のデータを受け取り、前方決定部107から前方の向きのデータを受け取る。方向転換判定部103は、メモリを有し、進行方向及び向きのデータを時間経過に応じて記憶する。そして、方向転換判定部103は、メモリに記憶された一定の時間範囲の進行方向について、方向転換がなされたか否かを判定する。
【0064】
歩幅決定部104は、歩行タイミング決定部101から1歩分の加速度データを受け取り、1歩毎の歩幅を決定する。決定された歩幅は、移動量積算部105へ出力される。尚、歩幅決定部104は、その歩幅の情報を方向転換判定部103にも出力する。
【0065】
移動量積算部105は、進行方向決定部102から進行方向の情報を受け取り、歩幅決定部104から歩幅の情報を受け取る。そして、移動量積算部105は、1歩分の進行方向及び歩幅を積算する。現在位置決定部106は、地図情報記憶部14から地図情報を取得し、積算された移動量から現在位置を特定する。現在位置決定部106は、方向転換判定部103が方向転換したと判定すれば、地図情報における近傍の交差点の位置を現在位置として決定する。また、方向転換していないと判定すれば(直進したと判定すれば)、マップマッチングによって投影された位置を、現在位置として決定する。
【0066】
本発明の特徴となる進行方向決定部102は、フィルタ部1021と、基準ベクトル導出部1022と、方位基準面算出部1023と、加速度面算出部1024と、方向角算出部1025と、補正部1026とを有する。フィルタ部1021及び補正部1026は、本発明について本質的な機能では無いが、これによって進行方向の精度を向上させることができる。
【0067】
基準ベクトル導出部1022は、複数の加速度データから重力方向の重力ベクトルを導出し、且つ、その重力ベクトルに対応する地磁気ベクトルを選択する。
【0068】
方位基準面算出部1023は、基準ベクトル導出部1022によって得られた1組の加速度ベクトル及び地磁気ベクトルから構成される方位基準面を算出する。方位基準面は、1組の加速度ベクトル及び地磁気ベクトルの外積から得られる。
【0069】
加速度面算出部1024は、単位区間中の複数の加速度ベクトル群を、例えば最小二乗法など既知の方法を用いて、平面に近似する。
【0070】
方向角算出部1025は、方位基準面算出部1023によって算出された方位基準面及び加速度面算出部1024によって算出された加速度面の両平面の法線ベクトルの間の角度から方向角θを算出する。加速度面と方位基準面の位置関係は、腕振り方向、即ち歩行者の進行方向によって変化する。
【0071】
フィルタ部1021は、基準ベクトル導出部1022に入力される加速度データ及び地磁気データについて、所定時間範囲のデータをメモリし、最大値及び最小値から所定割合のデータを除去する。即ち、突飛なデータを除去することができる。
【0072】
補正部1026は、方向角算出部1025から出力された方向角θについて、所定時間範囲の方向角θをメモリし、当該方向角θの前後の変化が所定角度閾値以上となっている方向角θを除去する。
【0073】
例えば、以下の表4のように、1つのデータだけが前後のデータよりも突飛な値、例えば90°(所定角度閾値)以上振れていた場合、そのデータを除去する。
【表4】

【0074】
また、補正部1026は、除去されたデータについて、以下の表5のように、時間的に前後に算出された単位区間の方向角θの平均によって補完することも好ましい。
【表5】

【0075】
更に、補正部1026は、蓄積した複数の方向角θの変化が、平均化することも好ましい。以下の表6によれば、一定範囲の方向角θ毎に、平均化したものである。
【表6】

【0076】
以上、詳細に説明したように、本発明の携帯端末、プログラム及び方法によれば、歩行者が、携帯端末を手持ちで歩行している場合であっても、その携帯端末に搭載された加速度センサ及び地磁気センサを用いて、歩行者の進行方向をできる限り正確に決定することができる。
【0077】
前述した本発明における種々の実施形態によれば、当業者は、本発明の技術思想及び見地の範囲における種々の変更、修正及び省略を容易に行うことができる。前述の説明はあくまで例であって、何ら制約しようとするものではない。本発明は、特許請求の範囲及びその均等物として限定するものにのみ制約される。
【図面の簡単な説明】
【0078】
【図1】歩行者の歩行態様と、加速度変動方向及び地磁気変動方向とを表す説明図である。
【図2】現実に発生する加速度面及び方位基準面を表す図である。
【図3】方向角θの向きを表す説明図である。
【図4】本発明の携帯端末における機能構成図である。
【符号の説明】
【0079】
1 携帯端末
10 マイクロプロセッサ部
101 歩行タイミング決定部
102 進行方向決定部
1021 フィルタ部
1022 基準ベクトル導出部
1023 座標系変換行列算出部
1024 座標系変換部
1025 方向角算出部
1025 補正部
103 方向転換判定部
104 歩幅決定部
105 移動量積算部
106 現在位置決定部
107 前方決定部
11 地磁気センサ
12 加速度センサ
13 GPS部
14 地図情報記憶部
15 ディスプレイ部

【特許請求の範囲】
【請求項1】
3軸の加速度データを出力する加速度センサと、3軸の地磁気データを出力する地磁気センサと、前記加速度データ及び前記地磁気データから歩行者の進行方向を決定する進行方向決定手段とを有し、歩行者によって所持される携帯端末であって、
前記進行方向決定手段は、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する基準ベクトル導出手段と、
前記重力ベクトルと前記地磁気ベクトルからなる方位基準面の法線ベクトルを導出する方位基準面導出手段と、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する加速度面算出手段と、
前記方位基準面の法線ベクトルと前記加速度面の法線ベクトルとのなす角を方向角として算出する方向角算出手段と
を有することを特徴とする携帯端末。
【請求項2】
前記加速度センサから入力された前記加速度データを、歩数毎、又は歩数に基づく時間単位毎に区分し、前記進行方向決定手段へ出力する歩行タイミング決定手段と、
前記進行方向決定手段から出力された、前記歩数毎、又は歩数に基づく時間単位毎の進行方向について、方向転換がなされたか否かを判定する方向転換判定手段と
を更に有することを特徴とする請求項1に記載の携帯端末。
【請求項3】
歩行者の歩行の向き、即ち、加速度面の前方を決定する前方決定手段を更に有し、
前記前方決定手段は、前記加速度センサから出力された加速度データ列における合成加速度の連続するピーク点のうち大きい方を、加速度面の前方として決定し、その旨を前記方向転換判定手段へ通知することを特徴とする請求項2に記載の携帯端末。
【請求項4】
前記基準ベクトル導出手段に入力される前記加速度データ及び前記地磁気データについて、
所定時間範囲のデータをメモリし、最大値及び最小値から所定割合のデータを除去するフィルタ手段を更に有することを特徴とする請求項1から3のいずれか1項に記載の携帯端末。
【請求項5】
前記方向角算出手段から出力された前記方向角θについて、
所定時間範囲の方向角θをメモリし、当該方向角θの前後の変化が所定角度閾値以上となっている方向角θを除去する補正手段を更に有することを特徴とする請求項1から4のいずれか1項に記載の携帯端末。
【請求項6】
3軸の加速度データを出力する加速度センサと、3軸の地磁気データを出力する地磁気センサとを有し、歩行者によって所持される携帯端末に搭載されたコンピュータを、前記加速度データ及び前記地磁気データから前記歩行者の進行方向を決定する進行方向決定手段として機能させる携帯端末用のプログラムであって、
前記進行方向決定手段は、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する基準ベクトル導出手段と、
前記重力ベクトルと前記地磁気ベクトルからなる方位基準面の法線ベクトルを導出する方位基準面導出手段と、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する加速度面算出手段と、
前記方位基準面と前記加速度面の両平面の法線ベクトルのなす角を方向角として算出する方向角算出手段と
してコンピュータを機能させることを特徴とする携帯端末用のプログラム。
【請求項7】
3軸の加速度データを出力する加速度センサと、3軸の地磁気データを出力する地磁気センサとを有し、歩行者によって所持される携帯端末について、前記加速度データ及び前記地磁気データから前記歩行者の進行方向を決定する進行方向決定方法であって、
複数の加速度ベクトルから重力方向の重力ベクトルを導出し、且つ、該重力ベクトルに対応する地磁気ベクトルを選択する第1のステップと、
前記重力ベクトルと前記重力ベクトルに対応する地磁気ベクトルの法線ベクトルを導出する第2のステップと、
複数の加速度ベクトルから加速度面の法線ベクトルを近似的に算出する第3のステップと、
前記方位基準面と前記加速度面の法線ベクトルのなす角を方向角として算出する第4のステップと
を有することを特徴とする携帯端末の進行方向決定方法。

【図1】
image rotate

【図2】
image rotate

【図3】
image rotate

【図4】
image rotate


【公開番号】特開2009−229399(P2009−229399A)
【公開日】平成21年10月8日(2009.10.8)
【国際特許分類】
【出願番号】特願2008−78135(P2008−78135)
【出願日】平成20年3月25日(2008.3.25)
【出願人】(000208891)KDDI株式会社 (2,700)
【Fターム(参考)】