JP2017526906A - 歩行者ナビゲーションデバイス及び方法 - Google Patents

歩行者ナビゲーションデバイス及び方法 Download PDF

Info

Publication number
JP2017526906A
JP2017526906A JP2017500028A JP2017500028A JP2017526906A JP 2017526906 A JP2017526906 A JP 2017526906A JP 2017500028 A JP2017500028 A JP 2017500028A JP 2017500028 A JP2017500028 A JP 2017500028A JP 2017526906 A JP2017526906 A JP 2017526906A
Authority
JP
Japan
Prior art keywords
acceleration component
component
posture
estimated
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.)
Granted
Application number
JP2017500028A
Other languages
English (en)
Other versions
JP6662842B2 (ja
Inventor
ジャナーダナン ジャヤワーダン
ジャナーダナン ジャヤワーダン
バラクリシャナン ジャイガネシュ
バラクリシャナン ジャイガネシュ
Original Assignee
日本テキサス・インスツルメンツ株式会社
テキサス インスツルメンツ インコーポレイテッド
テキサス インスツルメンツ インコーポレイテッド
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 日本テキサス・インスツルメンツ株式会社, テキサス インスツルメンツ インコーポレイテッド, テキサス インスツルメンツ インコーポレイテッド filed Critical 日本テキサス・インスツルメンツ株式会社
Publication of JP2017526906A publication Critical patent/JP2017526906A/ja
Application granted granted Critical
Publication of JP6662842B2 publication Critical patent/JP6662842B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00Measuring for diagnostic purposes; Identification of persons
    • A61B5/103Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/11Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb
    • A61B5/112Gait analysis
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/166Mechanical, construction or arrangement details of inertial navigation systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C22/00Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
    • G01C22/006Pedometers
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B2562/00Details of sensors; Constructional details of sensor housings or probes; Accessories for sensors
    • A61B2562/02Details of sensors specially adapted for in-vivo measurements
    • A61B2562/0219Inertial sensors, e.g. accelerometers, gyroscopes, tilt switches
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P15/00Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
    • G01P15/18Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration in two or more dimensions

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Health & Medical Sciences (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Automation & Control Theory (AREA)
  • Medical Informatics (AREA)
  • Molecular Biology (AREA)
  • Dentistry (AREA)
  • Biophysics (AREA)
  • Pathology (AREA)
  • Biomedical Technology (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Physiology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Surgery (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Navigation (AREA)

Abstract

歩行者ナビゲーションのためのデバイス及び方法の記載の例において、デバイス(300)が、加速度成分を感知するように構成される加速度計センサ(310)を含み、加速度成分は、加速度計センサの複数の軸におけるデバイスの動きに関連し、ストライド周波数成分及びステップ周波数成分を含む。デバイス(300)は、加速度計センサと通信可能に関連する処理モジュール(325)を含む。処理モジュールは、加速度計センサに対するデバイスの動きに関連する推定姿勢を判定するため加速度成分の少なくとも一部を処理するように構成される。処理モジュールは、ストライド周波数成分を遮断することによってステップ周波数成分をフィルタ出力するように構成される。処理モジュールはさらに、推定姿勢におけるデバイスの動きの横方向揺れに関連する偏りを軽減するためにステップ周波数成分に基づいて推定姿勢を判定するように構成される。

Description

本開示は概して歩行者ナビゲーションに関する。
歩行者ナビゲーションデバイスは、道路でユーザ位置情報を判定するために用いられる。このようなナビゲーションデバイスの多くは、それらのユーザによって任意のパターンで保持され得る、結びつけられていないデバイスの形態ともし得る。このようなナビゲーションデバイスは、ユーザの方向に関連する姿勢(attitude)を推定することによってユーザの動きの方向を判定する。例えば、この姿勢は、センサの方向に対するユーザの動き(又は、ナビゲーションデバイスはユーザによって携帯されるのでデバイスの動き)の方向として定義され得、センサの方向はナビゲーションデバイスに既知である。幾つかの状況では、姿勢推定は静的に成され得る。しかし、この方法は、ユーザがナビゲーションデバイスをユーザの動きの方向に向けることを必要とし得、この方向における姿勢は定量値「ゼロ」によって定義される。また、姿勢の動的推定が、ナビゲーションデバイスの向きに対する制約を低減又は除外する助けとなり得る。例えば、ユーザが、ナビゲーションデバイスの向きを縦向きから横向きに変更し得、また、ナビゲーションデバイスをユーザのシャツ又はズボンのポケットに入れて携帯し、その後、歩行者ナビゲーションに関するマップを見るためにナビゲーションデバイスを取り出すことさえあり得る。(例えばモバイルデバイスにおいて埋め込まれ得る)ナビゲーションデバイス用の低コストセンサ(加速度計、電子コンパス(eコンパス)、ジャイロスコープなど)を用いる、結びつけられていない歩行者ナビゲーションにおける動的姿勢推定は、業界全体の問題である。
歩行者ナビゲーションのためのデバイス及び方法の記載される例において、デバイスが、加速度成分を感知するように構成される加速度計センサを含み、加速度成分は加速度計センサの複数の軸におけるデバイスの動きに関連し、ストライド周波数成分及びステップ周波数成分を含む。このデバイスは、加速度計センサと通信可能に関連する処理モジュールを含む。処理モジュールは、加速度計センサに対するデバイスの動きに関連する推定姿勢を判定するために、加速度成分の少なくとも一部を処理するように構成される。処理モジュールは、加速度成分のストライド周波数成分を遮断することによって加速度成分のステップ周波数成分をフィルタ出力することにより、加速度成分を処理するように構成される。処理モジュールはさらに、推定姿勢におけるデバイスの動きの横方向動きに関連する偏りを軽減するために加速度成分のステップ周波数成分に基づいて推定姿勢を判定するように構成される。
幾つかの実施形態では、歩行者ナビゲーションのためのデバイスにおいて動作可能な方法が、全地球的基準方向に対するデバイスの加速度計センサの方向を判定すること、加速度計センサの複数の軸におけるデバイスの動きに関連する加速度成分を感知することを含む。加速度成分は、ストライド周波数成分及びステップ周波数成分を含む。この方法はさらに、加速度計センサに対するデバイスの動きの推定姿勢を判定するため、加速度成分を電子的に処理することを含む。電子的な処理は、少なくとも、加速度成分のストライド周波数成分を遮断することによって加速度成分のステップ周波数成分をフィルタ出力すること、及びデバイスの動きの横方向揺れに関連する推定姿勢における偏りを軽減するために、加速度成分のステップ周波数成分に基づいて推定姿勢を判定することを含む。この方法はさらに、ユーザ進行方向(heading)推定を生成するため、推定姿勢を加速度計センサの方向と電子的に組み合わせることを含む。
幾つかの実施形態では、歩行者ナビゲーションのためのデバイスにおいて動作可能な方法が、加速度計センサの複数の軸におけるデバイスの動きに関連する加速度成分を感知することを含む。加速度成分は、ストライド周波数成分及びステップ周波数成分を含む。この方法はさらに、加速度計センサに対するデバイスの動きの推定姿勢を判定するために、加速度成分の少なくとも一部を電子的に処理することを含む。電子的な処理は、少なくとも、加速度成分のストライド周波数成分を遮断することによって加速度成分のステップ周波数成分をフィルタ出力すること、及びデバイスの動きの横方向揺れに関連する推定姿勢における偏りを軽減するために、加速度成分のステップ周波数成分に基づいて推定姿勢を判定することを含む。
或る実施形態に従った、姿勢、及び全地球的基準方向に対するセンサ方向を示すように位置決めされるデバイスの例示表現である。
3つの加速度計軸及び全体加速度成分の各々について、時間に対する加速度成分測定の例示波形を示すグラフである。
例示実施形態に従った、歩行者ナビゲーションのためのデバイスの例示ブロック図表現である。
一実施形態に従った、姿勢推定の品質メトリックフィルタリングに関連する例示プロットを示すグラフである。
一実施形態に従った、品質メトリックフィルタリングの例示ブロック図表現である。 別の実施形態に従った、品質メトリックフィルタリングの例示ブロック図表現である。
一実施形態に従った、歩行者ナビゲーションの例示的方法のフローチャートである。
別の実施形態に従った、歩行者ナビゲーションの例示的方法のフローチャートである。
歩行者ナビゲーションデバイスにおける姿勢推定のための様々な実施形態を図1〜図7を参照して説明する。
「歩行者ナビゲーション」は、位置、方向、進行方向、傾き、姿勢、方位、高度、速度、加速度、及び急な動きの感知、及び/又は場所に基づくアプリケーション、位置に基づくアプリケーション、位置に基づくアプリケーション、歩数計アプリケーション、マップ関連アプリケーション、経路(軌道)制御、コース監視及び終了、限定領域又はゾーンに対する制約、操縦、自由落下検出、画像取得制御、画像安定化、及び上記の任意のものを組み合わせるアプリケーション又は上記の任意のものから恩恵を得る他のアプリケーションのいずれか1つ、いくつか、又は全てを含む。
姿勢推定を提供し得る様々なデバイス、又は、より具体的には歩行者ナビゲーションを提供し得る様々なデバイスは、ポータブルデバイス、ハンドヘルドデバイス、又はモバイルデバイスである。このようなデバイスは、本明細書の実施形態及び教示を利用し、それらから恩恵を得るために位置又は向きに関して十分に移動可能な、本明細書に記載のもの並びに他のものなどの任意の電子デバイスを含み得、このようなデバイスを下記では「歩行者ナビゲーションデバイス」と称する。
歩行者ナビゲーションデバイスが、歩行者ナビゲーションデバイスを携帯するユーザのスピード及び/又は距離の推定値、所定の方向(例えば磁北)に対する歩行者ナビゲーションデバイス内の1つ又は複数のセンサの方向、並びに加速度計センサに対するデバイスの動き(又は、歩行方向などのユーザの動き)の方向に対するこのようなモバイルデバイスの推定姿勢供給方向を計算するように構成される。いくつかの例示実施形態では、歩行者ナビゲーションデバイスは、所定の方向に対する歩行者ナビゲーションデバイス内の1つ又は複数のセンサの方向、及び歩行者ナビゲーションデバイスに関連する推定姿勢を計算するようにのみ構成され得る。このような例示実施形態では、スピード及び/又は距離の推定は、姿勢推定のために本明細書で開示する歩行者ナビゲーションデバイス(「デバイス」とも称する)にアクセス可能な又はこれと通信する適切なデバイス(歩数計など)によって実施され得る。或いは、幾つかの例示実施形態では、歩数計などのデバイスも歩行者ナビゲーションデバイスにおいて具現化され得る。
図1を参照すると、デバイス100(歩行者ナビゲーションデバイス)の例示表現が示されている。デバイス100は、結びつけられていない及び結びつけられたナビゲーションデバイスとともに用いられるように構成され、ユーザ進行方向(ユーザ進行方向推定)を判定するためユーザによって携帯され得る。説明のため、この結びつけられていないナビゲーションを、ユーザが移動する距離の推定と、ユーザ進行方向推定とに別々に分ける。ユーザが移動する距離は、当技術分野で知られているように、歩数計のプロセス及び回路要素の実施形態を用いて推定される。様々な実施形態がユーザ進行方向推定の解決策を提供する。
様々な実施形態では、ユーザ進行方向推定は2つの推定を判定することによって実施される。第1の推定が、全地球的基準方向(北など)に対するデバイスセンサ(加速度計センサなど)の方向であり、第2の推定が、デバイスセンサに対するユーザの動き(ユーザはデバイス100を携帯するので、「デバイスの動き」とも称する)の方向(姿勢)である。第1の推定はeコンパス及び/又はジャイロスコープを用いて判定され、第2の推定(姿勢)は加速度計センサとともに処理モジュールによって判定される。一例の実施形態において、デバイス100は推定姿勢しか判定し得ず、全地球的基準方向に対するデバイスセンサの方向は別のデバイスによって提供され得、推定姿勢及びデバイスセンサの方向両方が組み合わされてユーザ進行方向推定が判定される。加速度計センサ及び処理モジュールの様々な実施形態は、図2〜図7を参照して説明する。
図1に示すように、デバイス100は、角度105及び角度110の2つの方向を判定することによってユーザ進行方向推定を判定するように構成される。角度105は、磁北(MN115参照)とセンサ方向(120)との方向差を表わし、角度110は、センサ方向(120)とユーザ又はデバイスの動きの方向(125参照)との方向差を表わす。この説明のために、デバイス100が水平面内に置かれる場合、方向110は、デバイスの動き(又はユーザの動き)に関連する「姿勢」と称される。
図2において、未処理の加速度計測定値(加速度成分)が時間に対して示されている。典型的なユーザ歩行の動き(又は、デバイスがユーザによって携帯されているのでデバイスの動き)の間の加速度成分、例えば、ユーザの前方向成分(前方向加速度202として示す)、ユーザの横方向成分(横方向加速度204として示す)、及びユーザの鉛直方向成分(鉛直方向加速度206として示す)など、が図2に示されている。
図2では、加速度成分(前方向加速度202、横方向加速度204、及び鉛直方向加速度206)の二乗値の和の平方根などの大きさ(Amag)もグラフ上部にグラフ化されている(総加速度208として示す)。これらの加速度は、横軸(X軸)の時間に対して縦軸(Y軸)にプロットされている。図2のプロットから、前方向加速度202、横方向加速度204、及び鉛直方向加速度206のうち、鉛直方向加速度206の変動が最大であり、横方向加速度204に沿った変動が最小である。さらに、鉛直方向加速度206と前方向加速度202は、位相が約90度、即ち、ステップ継続時間のほぼ1/4、オフセットされている。例えば、図2に示すように、鉛直方向加速度206の波形が、前方向加速度202の波形より約90度進んでいる。
図3は、例示の実施形態に従った、歩行者ナビゲーションのためのデバイス300のブロック図である。デバイス300はデバイス100の例である。デバイス300は、加速度計センサ310及び処理モジュール325を含む。加速度計センサ310は、加速度計センサ310の複数の軸におけるデバイスの動きに関連する加速度成分を感知するように構成される。一例示実施形態では、デバイス300はまた、加速度計センサ310に対して物理的に固定されて配置され、全地球的基準方向(全地球的な北など)に対するデバイス進行方向推定を生成するように構成される、デバイス進行方向センサ320を含む。処理モジュール325は、加速度計センサ310に対するデバイスの動きに関連する推定姿勢を判定するように構成され、さらに、推定姿勢とデバイス進行方向推定を組み合わせることに基づいてユーザ進行方向推定を判定するように構成される。
一例の実施形態において、加速度計センサ310は、3軸加速度計であり、加速度計センサ310の、それぞれ、X、Y、及びZの3軸に沿った、AccX、AccY、AccZなどの加速度成分の測定を提供する。一般性を失うことなく、加速度計センサ310は、デバイス300(デバイス100の例)内部の仮想観測器であり、外部のことはわからない。デバイス300の或る面(X軸)が水平面と一致する場合、AccXは、デバイス300のディスプレイからデバイス300のこの面に沿って外向きに発する方向の加速度成分であり、AccYは、水平面内におけるX軸の方向に直交するY軸などの横方向の加速度成分であり、AccZは、デバイス300のディスプレイからの垂線などの鉛直面における加速度成分である。加速度計センサ310が、デバイス300内部の仮想観測器であり、外部のことがわからず、そのため、X軸は常に、デバイス300の向きに関わらずデバイス300の上部を指し、AccX、AccY、AccZ間の角度関係はデバイス300の向きに関わらず一定に維持され、これらの軸はパーソナルナビゲーション座標の軸と必ずしも一致する必要はないことが視覚化され得る。デバイス進行方向センサ320の例には、ジャイロスコープや、磁北などの全地球的基準方向に対する加速度計センサ310の方向の情報を提供するeコンパスが含まれ得るが、これらに限定されるものではない。
処理モジュール325は、データ記憶装置に記憶されるか又はその中に受け取られる、ソフトウェア命令、プロトコル、又は論理命令の実行又は性能を促進又は可能にするための、当業者に既知の様々なデバイスを含み得る。処理モジュール325は、マルチコアプロセッサ、シングルコアプロセッサ、又はマルチコアプロセッサとシングルコアプロセッサの組合せとして具現化され得る。例えば、処理モジュール325は、コプロセッサ、マイクロプロセッサ、コントローラ、デジタル信号プロセッサ(DSP)、DSP付き又はDSPなし処理回路要素、或いは特定用途向け集積回路(ASIC)、フィールドプログラマブルゲートアレイ(FPGA)、マイクロコントローラユニット(MCU)、ハードウェアアクセレレータ、又は特定目的コンピュータチップなどの集積回路を含む様々な他の処理デバイスなど、様々な処理手段の1つ又は複数として具現化され得る。処理モジュール325はまた、メモリデバイス(プロセッサキャッシュなど)、計時デバイス(リアルタイムクロック(RTC))、及び/又は追加の回路要素或いはデータ送信チャネルを含み得る。データ記憶装置は、複数の異なるデバイス又はデバイスの組合せによって具現化されてもよい。例えば、データ記憶装置は、1つ又は複数の揮発性及び/又は不揮発性メモリデバイスを含み得る。このようなデバイスの例には、ダイナミックランダムアクセスメモリ(DRAM)、スタティックランダムアクセスメモリ(SRAM)、プログラマブル読出し専用メモリ(PROM)、消去可能なプログラマブル読出し専用メモリ(EPROM)、及び電気的に消去可能なプログラマブル読出し専用メモリ(EEPROM)が含まれるが、これらに限定されるものではない。
処理モジュール325は、ステップ検出モジュール330、傾き推定モジュール335、傾き回復(de-tilt)モジュール340、及びステップ周波数フィルタリングモジュール350を含む。
ステップ検出モジュール330は、加速度成分(AccX、AccY、及びAccZ)におけるステップ周波数成分及びストライド周波数成分を判定するように構成される。一例の実施形態において、ステップ検出モジュール330は、これらの周波数成分を、加速度測定におけるゼロ交差の情報と、ステップ周波数が2/ストライド期間に等しいという仮定とを用いて判定する。ただし、ステップ検出モジュール330は、加速度計成分(AccX、AccY、及びAccZ)のパターン検出及び推定に基づいてステップ周波数成分及びストライド周波数成分を判定し得る。傾き推定モジュール335は、加速度計センサ310から受け取られる加速度成分(AccX、AccY、AccZ)及び(ステップ検出モジュール330から受け取られる)ステップ周波数成分及びストライド周波数成分の情報を用いたピッチ(Φ)及びロール(θ)出力などの、傾き測定を判定するように構成される。幾つかの実施形態では、これらの傾き測定は、通常、ユーザの動きの停止期間の間に、停止期間の間のサンプルを平均してノイズをフィルタリングすることによって推定され得る。これは、ユーザが動いている間は、測定にノイズが乗り過ぎて傾き推定のために平均できない可能性があるからである。幾つかの例示実施形態では、傾き推定モジュール335は、ストライドが検出されるたびに、ダイナミック傾き推定(及び追跡)のためそのストライドにわたって測定を平均するように構成される。これは、加速度測定波形が概してストライドにわたって周期的であり、正味の加速度が通常ゼロである(鉛直方向加速度成分を除く)からである。
傾き回復モジュール340は、傾き測定に基づいて複数のパーソナルナビゲーション軸に沿う傾き回復加速度成分を生成するため加速度成分を処理するように構成される。一例の実施形態において、パーソナルナビゲーション軸は、少なくとも、鉛直軸、第1の水平軸、及び第2の水平軸を含む。例えば、傾き回復は、加速度計成分AccX、AccY、AccZを、それぞれ、第1の水平軸、第2の水平軸、及び鉛直軸における加速度計成分に変える。例えば、傾き推定モジュール335は、デバイス300の現在の向きを判定し、次いで、傾きを回復して鉛直軸及び水平2次元面における加速度計示度を判定する。一例の実施形態において、傾き推定モジュール335は、傾き回復モジュール340にAccX、AccY、AccZに対応する傾き測定(ピッチ(Φ)及びロール(θ)出力)を提供する。傾き回復モジュール340は、歩行者パーソナル座標系(X’、Y’、V’)の傾き回復軸を判定するために、これらの入力(AccX、AccY、AccZ、Φ、及びθ)をすべて用いる。この説明では、歩行者のパーソナル座標系の座標(軸)である傾き回復座標(X’、Y’、V’)を参照し、ここで、座標X’は第1の水平軸に対応し、座標Y’は第2の水平軸に対応し、座標V’は鉛直軸に対応する。
様々な使用状況において、ユーザの歩行の特質によってはユーザの有意の側方揺れにより、加速度計測定における横方向加速度成分(図2の204によって示す)が増加する(ずれる)。横方向加速度成分204のこのような望ましくないずれは、姿勢の推定(推定姿勢の判定)を異なる様式で偏らせ得る。このように、側方の揺れは、ストライド周波数(ステップ周波数の半分)で周期的であり、ストライドは2つの連続ステップ(左ステップ及び右ステップ)からなる。一例の実施形態において、ステップ周波数フィルタリングモジュール350は、傾き回復加速度成分からのストライド周波数成分を遮断することによってフィルタリングされた加速度成分を生成するように構成される。例えば、ステップ周波数フィルタリングモジュール350は、ストライド周波数成分をフィルタリングし、傾き回復加速度成分のステップ周波数成分のみを通過させるように構成される。処理モジュール325は、傾き回復加速度成分のステップ周波数成分の処理に基づいて、デバイスの動きに関連する推定姿勢を判定するように構成される。このように、推定姿勢は他の測定及び推定と結びつけられ、群遅延をもたらすいかなるフィルタリングでも、姿勢の推定が複雑となる。一般性を失うことなく、ステップ周波数フィルタリングモジュール350の一例は、高速フーリエ変換(FFT)ベースの遮断フィルタである。ストライド(2ステップ)が既に検出されている場合、1ストライド相当データをFFTベースの遮断フィルタを通過させることによって、変換成分は、F(0)(直流成分)、F(1)(ストライド周波数)、及びF(2)(ステップ周波数)となる。FFTベースの遮断フィルタは、姿勢の推定のさらなる処理のため、F(1)を遮断し、成分F(2)(ステップ周波数成分)のみを通過させるように構成される。他の例示実施形態において、ステップ周波数成分はまた、Goertzelアルゴリズム又は任意の他の適切な手段を用いて演算され得る。
説明のため、フィルタリングされた加速度成分を、第1の水平軸に沿う第1の水平加速度成分(AccX’)、第2の水平軸に沿う第2の水平加速度成分(AccY’)、及び鉛直軸に沿う鉛直方向加速度成分(AccV)と称する。フィルタリングされた加速度成分(AccX’、AccY’、及びAccV)は、続いて、デバイスの動きに関連する推定姿勢を判定するため処理される。例えば、ステップ周波数フィルタリングモジュール350の出力(AccX’、AccY’、及びAccV)は、事前姿勢推定モジュール355及び回転回復(de-rotate)モジュール360に提供される。一例の実施形態において、事前姿勢推定モジュール355は、事前姿勢推定出力を入力として回転回復モジュール360に提供する。事前姿勢推定モジュール355は、加速度の変動が、デバイスの動きの横方向に沿って最小であり、鉛直軸AccVに沿って最大であるという仮定に基づいて事前姿勢を計算するように動作する。また、水平面において、この変動が、前方向に沿って最大であり、デバイスの動きの横方向に沿って最小であると仮定する。したがって、事前姿勢推定モジュール355は、AccX’及びAccY’の値に基づいて、パーソナルナビゲーション座標の水平面において最大変動(前方向の推定)の軸を見つけることによって事前姿勢を計算するように構成される。事前姿勢は、加速度計方向に対するデバイスの動きの前方向の事前推定のみを提供するが、事前姿勢は、依然として、(デバイスの動きの方向が前方向であるか又は後ろ方向であるかについて)0−π曖昧さを有する。
一般性を失うことなく、一例の実施形態において、事前姿勢は、下記の式に基づいて事前姿勢推定モジュール355によって判定され得る。
ここで、RxxはAccX’の自己共分散であり、RyyはAccY’の自己共分散であり、RxyはAccX’とAccY’の相互共分散である。AccX’及びAccY’は、ステップ周波数フィルタリングモジュール350から受け取られる(パーソナルナビゲーション軸の)第1の水平軸及び第2の水平軸におけるフィルタリングされた加速度成分を表す。
一例の実施形態において、回転回復モジュール360は、AccX’、 AccY’、及び事前姿勢に基づいて、(水平面における最大変動の軸における)AccF’など、事前前方向加速度成分を生成するように構成される。例えば、AccX’及びAccY’を事前姿勢に対応する角度、回転することによって、事前前方向加速度成分AccF’(水平面における最大変動の方向における加速度)が事前推定され得る。一例の実施形態において、回転回復モジュール360はまた、AccX’、 AccY’、及び事前姿勢に基づいて事前横方向加速度成分(AccL’など)を提供するように構成される。例えば、AccX’及びAccY’を事前姿勢に対応する角度、回転することによって、事前横方向加速度成分(AccL’)が事前推定され得る。事前姿勢は、加速度計センサ方向に対するデバイスの動きの前方向の事前推定のみ提供するが、事前姿勢は、依然として、(デバイスの動きの方向が前方向であるか又は後ろ方向であるかについて)0−π曖昧さを有する。
一例示実施形態において、0−π曖昧さ推定モジュール365が、(推定事前姿勢に基づいて得られる)回転回復モジュール360から受け取られる入力の0−π曖昧さを解決するように構成される。一例示実施形態において、0−π曖昧さ推定モジュール365は、事前前方向加速度成分(AccF’)と、90度位相回転された鉛直方向加速度成分(AccV)との相互共分散に基づいて、事前前方向加速度成分(AccF’)と鉛直方向加速度成分(AccV)の進み関係又は遅れ関係の感知を検出するように構成される。この例示実施形態では、0−π曖昧さ推定モジュール365は、関係(AccF’とAccVの進み関係又は遅れ関係)の感知の検出結果に基づいて、デバイスの動きの方向が前方向であるか又は後ろ方向であるかを判定するように構成される。
一例示実施形態において、0−π曖昧さ推定モジュール365は、下記の式に基づいて推定姿勢を判定する。
fv<0である場合、推定姿勢=事前姿勢+π
fv>0である場合、推定姿勢=事前姿勢 式(2)
ここで、RfvはAccF’と90°(90度)位相回転された、又は、ステップ継続時間の1/4等価に遅れたAccVの相互共分散である。式(2)から、推定ユーザ方向は、AccF’と90°位相回転されたAccVとの間の相互共分散(Rfv)が正である場合、前方向であり、AccF’と90°位相回転されたAccVとの間の相互共分散(Rfv)が負である場合、後ろ方向である。したがって、一例示実施形態において、デバイスの動きの前方向加速度(AccFで表される)が、事前前方向加速度成分AccF’、及びAccF’とAccVとの間の関係の検出された感知に基づいて計算される。同様に、デバイスの動きの横方向加速度(AccLで表される)が、事前横方向加速度成分AccL’、及びAccF’とAccVとの間の関係の検出された感知に基づいて計算される。
別の例示実施形態において、処理モジュール325などの処理モジュールが、0−π曖昧さ推定モジュール365を含まず、この処理モジュールは、下記の式に基づいて姿勢を判定するように構成され得る。
姿勢=tan−1(Rxv/Ryv)+π/2 式(3)
ここで、Rxvは、AccX’のAccVとの相互共分散であり、Ryvは、AccY’のAccVとの相互共分散である。
或る例示実施形態では、処理モジュール325は、式(2)又は式(3)によって得られた推定姿勢を再調整して、一連の高品質の姿勢推定を提供するように構成される。例えば、0−π曖昧さ推定モジュール365は、下記の式に基づく姿勢推定のための品質メトリック因子(quality metric factor)(YawQM)を提供するように構成される。
ここで、Rfvは、AccF(前方向加速度成分)とAccV(鉛直方向加速度成分)の相互共分散であり、Rff及びRvvは、それぞれ、AccF及びAccVの自己共分散である。YawQMの値が±1に近い場合、姿勢推定は正確になる。YawQMの値がゼロに近い場合、小さなレベルの「ノイズ」でも符号の反転が生じる恐れがあり、それによって、姿勢の誤った推定が起こり得る。したがって、再調整された推定姿勢(「品質フィルタリングされた姿勢」又は「推定姿勢」とも称する)を生成するため、YawQMの大きさに基づいて、推定姿勢がさらに再調整される。
一例示実施形態において、処理モジュール325は、品質メトリックフィルタ370を含み、品質メトリックフィルタ370は、(事前姿勢推定モジュール355から受け取られる)事前姿勢、(0−π曖昧さ推定モジュール365から受け取られる)AccF’とAccVとの間の進み関係又は遅れ関係の感知、及びYawQMに基づいて、再調整された推定姿勢(「推定姿勢」とも称する)を判定するように構成される。一例示実施形態において、処理モジュール325はユーザ進行方向推定モジュール375を含み、ユーザ進行方向推定モジュール375は、入力、即ち、(デバイス進行方向センサ320から受け取られる)デバイス進行方向推定、及び(品質メトリックフィルタ370から受け取られる)推定姿勢を受け取る。ユーザ進行方向推定モジュール375は、推定姿勢をデバイス進行方向推定と電子的に組み合わせて、全地球的基準方向(北など)に対するユーザ進行方向を提供するユーザ進行方向推定を生成するように構成される。一例示実施形態において、デバイス300は品質メトリックフィルタ370を含まず、0−π曖昧さ推定モジュール365が、回転回復モジュール360から受け取られる入力の0−π曖昧さを解決し、推定姿勢を提供する。この実施形態では、ユーザ進行方向推定モジュール375は、(0−π曖昧さ推定モジュール365から受け取られる)推定姿勢をデバイス進行方向推定と組み合わせてユーザ進行方向推定を生成し得る。
品質メトリックフィルタリングに関連するプロットの例示表現を図4に示す。図4を参照すると、(例えば、式(2)から判定される)推定姿勢の大きさ(角度)、(式(4)から判定される)YawQM、及び再調整された推定姿勢(又は品質フィルタリングされた姿勢)の時間に対するグラフが示されている。例えば、プロット410は、YawQMを表し、プロット420は、(事前姿勢推定モジュール355及び0−π曖昧さ推定モジュール365から得られる)入力推定姿勢を表し、プロット430は再調整された推定姿勢を表す。
図4では、(430で示される)再調整された推定姿勢は、YawQM(410で示される)の大きさに基づいて(420で示される)入力推定姿勢をフィルタリングすることに基づいて得られるフィルタリングされた推定姿勢である。例えば、(420で示される)入力推定姿勢の(部分412に対応する)部分422、(部分414に対応する)部分424、及び(部分416に対応する)部分426は、(430で示される)再調整された推定姿勢では遮断されている。
再調整された推定姿勢を生成するための品質メトリックフィルタリングの実装の幾つかの例示実施形態が図5A及び図5Bに示されている。図5Aに示すように、事前姿勢推定モジュール355によって受け取られる事前姿勢(502参照)は、0−π曖昧さ推定モジュール365によって受け取られる0/π信号(又は入力)(AccF’とAccVとの間の進み/遅れ関係を表す504参照)によって補正されて、0−π補正姿勢(506参照)が生成される。また、品質メトリックフィルタ370は、0−π補正姿勢506及びYawQM(508参照)を入力として受け取り、再調整された推定姿勢である推定姿勢(510参照)を生成するように構成される。
図5Aのこの例示実施形態では、品質メトリックフィルタ370は、下記の式に基づいて、再調整された推定姿勢Yawを生成し得る。
YawFiltn=Yaw×abs(YawQM)+YawFiltn-1×(1-abs(YawQM)) 式(5)
ここで、YawFiltは、時間tにおける推定姿勢であり、YawFiltn−1は、時間tn−1における推定姿勢であり、Yawは、時間tにおける事前姿勢とデバイスの動きの方向とに基づいて推定される姿勢である。上記の式(5)から、YawQMがゼロに近づくと、YawFiltは、YawFiltn−1に等しいなど、先行する再調整された推定姿勢にほぼ等しくなる。また、YawQMが1に近づくと、YawFiltは、Yawなどの推定姿勢の現在の値に等しくなる。
再調整された推定姿勢を判定する別の実施形態が図5Bに示されている。図5Bに示すように、事前姿勢(522参照)は、YawQM(554参照、0−π曖昧さ推定モジュール365から受け取られる)に基づいて、品質メトリックフィルタ370によってフィルタリングされて、フィルタリングされた姿勢信号(556参照)が生成される。この実施形態では、事前姿勢552は、YawQMの飽和値に基づいてフィルタリングされる。例えば、YawQMが実質的に1に等しいとき、フィルタリングされた姿勢信号(556参照)が生成される。
この実施形態では、0−πを表す信号(0/π信号558参照)が、別個の0−πフィルタ560によって生成され、再調整された推定姿勢(570)が、フィルタリングされた姿勢信号556及び信号558に基づいて生成される。
本明細書で説明する特徴の幾つかは、モジュール(例えば、傾き推定モジュール335、事前姿勢推定モジュール355など)として説明した。これは、これらのモジュールの実装の独立性をより特別に強調するためである。モジュールは、カスタムの超大規模集積(VLSI)回路又はゲートアレイや、論理チップ、トランジスタ、又は他の個別構成要素などの汎用の半導体を含む、ハードウェア回路として実装され得る。また、モジュールは、フィールドプログラマブルゲートアレイ、プログラマブルアレイ論理、プログラマブル論理デバイス、及びグラフィック処理ユニットなどのプログラマブルハードウェアデバイスとして実装され得る。
本明細書に記載のモジュールはまた、少なくとも部分的に、様々なタイプのプロセッサによって実行されるソフトウェアにおいて実装され得る。例えば、実行可能なコードの識別されたユニットが、オブジェクト、プロシージャ、又は関数として構成され得るコンピュータ命令の1つ又は複数の物理又は論理ブロックを含み得る。そうではあるが、識別されたモジュールの実行可能ファイルは物理的に一緒に配置される必要はなく、異なる場所に記憶される異種命令を含み得る。これらの命令は、論理的に結合されると、モジュールを含み、モジュールの規定された目的を達成する。また、モジュールは、ハードディスクドライブ、フラッシュデバイス、ランダムアクセスメモリ(RAM)、テープ、又は任意の他のこのようなデータ記憶用媒体などとし得るコンピュータ可読媒体に記憶され得る。
実際、実行可能なコードのモジュールが、単一の命令又は複数の命令とされ得、さらには、幾つかの異なるコードセグメントにわたって、異なるプログラム間で、及び、幾つかのメモリデバイス全体にわたって、分配され得る。同様に、動作データが、モジュール内で識別及び示され得、任意の適切な形式で具現化され得、任意の適切なタイプのデータ構造内で構成され得る。動作データは、単一のデータ集合として収集され得、又は、異なる記憶デバイスにわたることを含めて異なる場所にわたって分配され得、また、少なくとも部分的に単にシステム又はネットワーク上の電子信号として存在し得る。
姿勢推定の方法及びユーザ進行方向推定の判定の方法の様々な例示実施形態を、図3〜図5Bを参照して暗示的に説明する。この方法/プロセスの幾つかの例示実施形態が、図6及び図7を参照してさらに提供される。
ここで図6を参照すると、実施形態に従って方法600が示されている。方法600は、図1及び図3を参照して説明したようなデバイス100又は300などのナビゲーションデバイスにおいて実装され得る。
方法600は、605で、全地球的基準方向に対する歩行者ナビゲーションのためのデバイスの加速度計センサの方向を判定することを含む。説明のために、全地球的基準方向に対するデバイスの加速度計センサの方向を「デバイス進行方向」とも称する。例えば、デバイス進行方向は、磁北などの全地球的基準方向に対するデバイスセンサ(加速度計センサ310など)の方向である。デバイス進行方向は、適切なデバイス進行方向センサによって判定され得る。適切なデバイス進行方向センサには、全地球的基準方向に対する加速度計センサの方向の情報を提供するジャイロスコープ及びeコンパスが含まれるが、これらに限定されるものではない。
方法600は、610で、加速度計センサの複数の軸におけるデバイスの動きに関連する加速度成分を感知することを含む。或る例示実施形態では、加速度計センサ310(3軸加速度計など)などの加速度計センサは、3つの軸における加速度成分の測定を提供する。加速度成分は、デバイスの或る面に対するものであり、測定の方向はデバイスの向きに関わらず一定である。或る例では、加速度成分の測定は、例えば、図3を参照して説明したようなAccX、AccY、及びAccZなど、X、Y、及びZの3つの軸に沿い得る。一般性を失うことなく、AccXは、デバイスの面におけるデバイスのディスプレイから外向きに発する加速度成分であり、AccYは、AccXに直交してデバイスの面において横方向に発する加速度成分であり、AccZは、AccX及びAccYに直交してデバイスの面においてディスプレイを超えて発する加速度成分である。例えば、デバイスが水平面内に置かれる場合、AccX及びAccYは水平面における加速度測定であり、AccZは鉛直面における加速度測定である。
方法600は、615で、加速度計センサに対するデバイスの動きに関連する推定姿勢を判定するために、加速度成分の少なくとも一部を電子的に処理することを含む。ブロック615の動作は、ブロック620及び625によって実施される少なくとも2つの動作を含む。方法600は、620で、加速度成分のストライド周波数成分を遮断することによって加速度成分のステップ周波数成分をフィルタ出力することを含む。さらに、方法600は、625で、加速度成分のステップ周波数成分に基づいて、デバイスの動きに関連する推定姿勢を判定することを含み、それによって、デバイスの動きの横方向揺れに関連する推定姿勢における偏りを軽減する。
方法600は、630で、ユーザ進行方向推定を生成するため、推定姿勢を(605で判定された)全地球的基準方向に対するデバイスの加速度計センサの方向と電子的に組み合わせることを含む。
一例示実施形態において、ブロック605及び630の動作は任意選択であり得、方法600は、推定姿勢を判定するためブロック610及び615(620及び625を含む)の動作のみを含み得る。図6において提供される幾つかの動作は、或る順で実施される個別の構成ステップとして説明されている。このような実装は単なる例であり、範囲を限定するものではない。或る動作がまとめてグループ化され単一の動作で実施され得、幾つかの動作が、本明細書に記載される例で用いられる順とは異なる順で実施され得る。例えば、デバイス進行方向を判定する動作(605で示される)は、ブロック630で実施される動作とともに、又は、ブロック630で実施される動作の直前の動作で、実施され得る。また、方法600の或る動作が自動で実施される。こういった動作は実質的にユーザとの相互作用に関与しない。方法600の他の動作が、手作業又は半自動で実施され得る。こういった動作は、1つ又は複数のユーザインターフェースの提示を介したユーザとの相互作用に関与する。
ここで図7を参照して、姿勢推定及びその後のユーザ進行方向推定のための方法700の例示実施形態を示す。方法700は、705で、全地球的基準方向に対するデバイスの加速度計センサの方向を判定することを含む。動作705の一例は、図6を参照して説明した動作605である。
方法700は、710で、複数軸におけるデバイスの動き(ユーザがデバイスを携帯するので「ユーザの動き」とも称する)に関連する加速度成分を感知することを含む。動作710の一例は、図6を参照して説明した動作610である。加速度成分の例は、図3を参照して説明したAccX、AccY、及びAccZである。
方法700は、715で、加速度成分のステップ周波数成分を判定することを含む。方法700は、720で、加速度成分(AccX、AccY、及びAccZ)に関連する傾き測定(ピッチ(Φ)及びロール(θ)など)を計算することを含む。方法700は、725で、傾き測定に基づいて、複数のパーソナルナビゲーション軸に沿う傾き回復加速度成分を生成することを含む。一例示実施形態において、パーソナルナビゲーション軸は、少なくとも、鉛直軸、第1の水平軸、及び第2の水平軸を含む。
方法700は、730で、傾き回復加速度成分をフィルタリングして、傾き回復加速度成分のストライド周波数成分を遮断することによってステップ周波数成分のみを保持して、フィルタリングされた加速度成分を生成することを含む。この説明のために、フィルタリングされた加速度成分は、第1の水平加速度成分(AccX’)、第2の水平加速度成分(AccY’)、及び鉛直加速度成分(AccZ)と称する3つの測定を含む。
方法700は、735で、下記の式に基づいて事前姿勢を判定することを含む。
ここで、Rxxは第1の水平加速度成分の自己共分散であり、Ryyは第2の水平加速度成分の自己共分散であり、Rxyは第1の水平加速度成分と第2の水平加速度成分の相互共分散である。事前姿勢は、水平面における最大変動の方向を提供する。
方法700は、740で、事前前方向加速度成分(AccF’)生成するため、事前姿勢に応答して第1の水平加速度成分(AccX’)を回転回復することを含む。例えば、AccX’を事前姿勢に対応する角度回転することによって、事前前方向加速度成分(水平面における最大変動の方向の加速度)が事前推定され得る。一例示実施形態において、方法700は更に、740で、事前横方向加速度成分(AccL’)を生成するため、事前姿勢に応答して第2の水平加速度成分(AccY’)を回転回復することを含む。
方法700は、745で、事前前方向加速度成分(AccF’)と鉛直加速度成分(AccV)の間の進み関係又は遅れ関係の一方を、AccF’と90度位相回転された鉛直加速度成分AccVとの相互共分散に基づいて検出することを含む。例えば、或る関係(AccF’とAccVの間の進み関係又は遅れ関係のいずれか)が、AccF’と90度位相回転されたAccVとの相互共分散に基づいて判定される。方法700は、750で、AccF’とAccVの間の検出された関係に基づいて、デバイスの動きの方向を前方向又は後ろ方向のいずれかとして判定することを含む。デバイスの動きの判定された方向は、デバイスの動きが前方向であるか又は後ろ方向であるかを表す。一例示実施形態において、デバイスの動きの方向を判定することによって、0−π曖昧さが解決される。
一例示実施形態において、方法700は、事前姿勢とデバイスの動きの方向とに基づいてデバイスの動きに関連する推定姿勢を判定するための動作を含み得る。幾つかの他の例示実施形態において、方法700はさらに、ユーザの動きにおける偽の回転によって生じる姿勢推定におけるまれな90°/180°誤差を除去するために品質メトリックフィルタリングによって推定姿勢を再調整する。
一例示実施形態において、方法700は、ステップ755で、任意選択で、一連の高品質の姿勢推定を提供するために、式(2)及び式(3)によって得られた推定姿勢を再調整することを含む。例えば、下記の式に基づいて品質メトリック因子が判定される。
ここで、Rfvは、AccF(前方向加速度成分)とAccV(鉛直加速度成分)の相互共分散であり、Rff及びRvvは、それぞれ、AccF及びAccVの自己共分散である。YawQMの値が±1に近い場合、姿勢推定はより良好になる。YawQMの値がゼロに近い場合、小さなレベルの「ノイズ」でも符号の反転が生じる恐れがあり、それによって、姿勢の誤った推定が起こり得る。したがって、YawQMの大きさに基づいて、再調整された推定姿勢(「品質フィルタリングされた姿勢」又は「推定姿勢」とも称する)を生成するため、推定姿勢をさらに再調整する。
方法700は、760で、事前姿勢(ブロック735で判定される)、デバイスの動きの方向(ブロック750で判定される)、及びYawQM(ブロック755で判定される)に基づいて、推定姿勢を計算することを含む。
方法700は、ブロック765で、ユーザ進行方向推定を生成するため、推定姿勢を(ブロック705で判定される)全地球的基準方向に対する加速度計センサの方向と電子的に組み合わせることを含む。ユーザ進行方向推定は、北などの全地球的基準方向に対するユーザ進行方向を提供する。
図7において提供される幾つかの動作は、或る順で実施される個別の構成ステップとして説明される。このような実装は単なる例であり、範囲を限定的するものではない。或る動作がまとめてグループ化され単一の動作で実施され得、幾つかの動作が、本明細書に記載される例で用いられる順とは異なる順で実施され得る。例えば、加速度計センサの方向を判定する動作(705で示される)は、ブロック765で実施される動作とともに、又は、ブロック765で実施される動作の直前の動作として、実施され得る。また、方法700の或る動作が自動で実施される。こういった動作は実質的にユーザとの相互作用に関与しない。方法700の他の動作が手作業又は半自動で実施され得る。こういった動作は、1つ又は複数のユーザインターフェースの提示を介したユーザとの相互作用に関与する。
これらの例示実施形態は、デバイスの動き(又はユーザの動き)に関連する横方向揺れによって生じる誤った測定を排除する姿勢推定を提供する。様々な実施形態が姿勢の閉形式推定を提供する。例えば、姿勢の推定は、正確な姿勢推定を提供し、演算上効果的な、数学的表現の組に基づいて実施される。また、推定姿勢は、ユーザ進行方向を判定する際のまれな90°/180°誤差を除去する品質メトリックフィルタリングによって再調整される。品質メトリックの演算は姿勢の各瞬時的推定に対して実施されるので、品質メトリックを用いる時間にわたる推定姿勢のフィルタリングが、より正確な姿勢推定を提供する。さらに、様々な実施形態により、携帯電話などのモバイルアプリケーションにおいて集積化され得る低コストの微小電子機械システム(MEMS)センサを用いることによって歩行者ナビゲーションのための費用対効果が高く効果的な解決策が提供される。
記載の例において、ハードウェア回路要素(例えば、相補型金属酸化物半導体(CMOS)ベースの論理回路要素)、及び/又はハードウェアとソフトウェアの任意の組合せ(例えば、機械可読媒体において具現化される)を用いて、様々なデバイス、モジュール、アナライザ、及びジェネレータがイネーブルされ、動作される。例えば、様々な電気構造が、トランジスタ、論理ゲート、及び電気回路(例えば、ASIC回路要素及び/又はデジタル信号プロセッサ(DSP)回路要素)を用いて具現化され得、図面は限定的な意味でなく例示として見なされたい。
特許請求の範囲内で、説明した実施形態において改変が可能であり、他の実施形態が可能である。

Claims (20)

  1. 歩行者ナビゲーションのためのデバイスであって、
    加速度成分を感知するように構成される加速度計センサであって、前記加速度成分が、前記加速度計センサの複数の軸におけるデバイスの動きに関連しており、ストライド周波数成分及びステップ周波数成分を含む、前記加速度計センサ、及び
    前記加速度計センサと通信可能に関連する処理モジュール、
    を含み、
    前記処理モジュールが、前記加速度計センサに対する前記デバイスの動きに関連する推定姿勢を判定するために、
    前記加速度成分の前記ストライド周波数成分を遮断することによって前記加速度成分の前記ステップ周波数成分をフィルタ出力すること、及び
    前記推定姿勢における前記デバイスの動きの横方向揺れに関連する偏りを軽減するために前記加速度成分の前記ステップ周波数成分に基づいて前記推定姿勢を判定すること、
    によって、前記加速度成分の少なくとも一部を処理するように構成される、
    デバイス。
  2. 請求項1に記載のデバイスであって、前記処理モジュールが、
    前記加速度成分に関連する傾き測定を計算するための傾き推定モジュール、
    前記傾き測定に基づいて複数のパーソナルナビゲーション軸に沿う傾き回復(de-tilt)加速度成分を生成するために前記加速度成分を処理するように構成される傾き回復モジュールであって、前記複数のパーソナルナビゲーション軸が、少なくとも、鉛直軸、第1の水平軸、及び第2の水平軸を含む、前記傾き回復モジュール、及び
    フィルタリングされた加速度成分を生成するためのステップ周波数フィルタリングモジュール、
    を含み、
    前記フィルタリングされた加速度成分が、前記傾き回復加速度成分からの前記ストライド周波数成分を遮断することによって生成され、前記フィルタリングされた加速度成分が、鉛直加速度成分、前記第1の水平軸に沿う第1の水平加速度成分、及び前記第2の水平軸に沿う第2の水平加速度成分を含む、
    デバイス。
  3. 請求項2に記載のデバイスであって、前記処理モジュールがさらに、式
    に基づいて事前姿勢を判定するように構成される事前姿勢推定モジュールを含み、前記式において、Rxxは前記第1の水平加速度成分の自己共分散であり、Ryyは前記第2の水平加速度成分の自己共分散であり、Rxyは前記第1の水平加速度成分と前記第2の水平加速度成分の相互共分散である、デバイス。
  4. 請求項3に記載のデバイスであって、前記処理モジュールが、事前前方向加速度成分を生成するため、前記事前姿勢に応答して前記第1の水平軸加速度成分を回転回復する(de-rotate)ように構成され、かつ、事前横方向加速度成分を生成するため、前記事前姿勢に応答して前記第2の水平軸加速度成分を回転回復するように構成される、回転回復モジュールを含む、デバイス。
  5. 請求項4に記載のデバイスであって、前記処理モジュールがさらに0−π曖昧さ推定モジュールを含み、
    前記0−π曖昧さ推定モジュールが、
    前記事前前方向加速度成分と前記鉛直加速度成分との間の進み関係又は遅れ関係の一方を、前記事前前方向加速度成分と90度位相回転された鉛直加速度成分との相互共分散に基づいて検出するように、及び
    前記検出された関係に基づいて前記デバイスの動きの方向が前方向であるか又は後ろ方向であるかを判定するように、
    構成される、デバイス。
  6. 請求項5に記載のデバイスであって、前記事前前方向加速度成分と前記90度位相回転された鉛直加速度成分との間の相互共分散が正である場合、前記デバイスの動きの前記方向が前記前方向であり、前記事前前方向加速度成分と前記90度位相回転された鉛直加速度成分との間の前記相互共分散が負である場合、前記デバイスの動きの前記方向が前記後ろ方向である、デバイス。
  7. 請求項6に記載のデバイスであって、前記処理モジュールがさらに、前記事前姿勢と前記前方向及び前記後ろ方向の一方である前記デバイスの動きの前記方向とに基づいて前記推定姿勢を判定するように構成される、デバイス。
  8. 請求項5に記載のデバイスであって、前記0−π曖昧さ推定モジュールがさらに、式
    に基づいて品質メトリック因子を生成するように構成され、前記式において、Rfvは前記前方向加速度成分と前記鉛直加速度成分の相互共分散であり、Rffは前記前方向加速度成分の自己共分散であり、Rvvは前記鉛直加速度成分の自己共分散である、デバイス。
  9. 請求項8に記載のデバイスであって、前記処理モジュールが、前記事前姿勢、前記デバイスの動きの前記方向、及び前記品質メトリック因子に基づいて、前記推定姿勢を判定するように構成される、デバイス。
  10. 請求項9に記載のデバイスであって、前記推定姿勢が、式
    YawFiltn = Yawn×abs(YawQM)+YawFiltn-1×(1-abs(YawQM))
    に基づいて判定され、前記式において、YawFiltは時間tにおける推定姿勢であり、YawFiltn−1は時間tn−1における推定姿勢であり、Yawは、時間tにおける前記事前姿勢と前記デバイスの動きの前記方向とに基づいて判定される姿勢である、デバイス。
  11. 請求項2に記載のデバイスであって、前記デバイスがさらに、前記品質メトリック因子及び事前姿勢に基づいて前記推定姿勢を判定するように構成され、前記事前姿勢が、式
    姿勢=tan−1(Rxv/Ryv)+π/2
    によって判定され、前記式において、Rxvが前記事前前方向加速度成分と前記鉛直加速度成分の相互共分散であり、Ryvが前記事前横方向加速度成分と前記鉛直加速度成分の相互共分散である、デバイス。
  12. 請求項1に記載のデバイスであって、前記加速度計センサに物理的に固定して配置され、全地球的基準方向に対する前記デバイスの前記加速度計センサの方向を判定するように構成される、デバイス進行方向(heading)センサをさらに含み、前記処理モジュールがさらに、ユーザ進行方向推定を判定するために前記推定姿勢を前記加速度計センサの前記方向と組み合わせるように構成される、デバイス。
  13. 歩行者ナビゲーションのためのデバイスにおいて動作可能な方法であって、前記方法が、
    全地球的基準方向に対する前記デバイスの加速度計センサの方向を判定すること、
    前記加速度計センサの複数の軸におけるデバイスの動きに関連する加速度成分を感知することであって、前記加速度成分がストライド周波数成分及びステップ周波数成分を含むこと、
    前記加速度計センサに対する前記デバイスの動きの推定姿勢を判定するために前記加速度成分を電子的に処理することであって、前記電子的に処理することが少なくとも、
    前記加速度成分の前記ストライド周波数成分を遮断することによって前記加速度成分の前記ステップ周波数成分をフィルタ出力することと、
    前記デバイスの動きの横方向揺れに関連する前記推定姿勢における偏りを軽減するために、前記加速度成分の前記ステップ周波数成分に基づいて前記推定姿勢を判定することと、
    を含む、前記電子的に処理すること、及び
    ユーザ進行方向推定を生成するために前記推定姿勢を前記加速度計センサの前記方向と電子的に組み合わせること、
    を含む、方法。
  14. 請求項13に記載の方法であって、前記電子的に処理することがさらに、
    前記加速度成分に関連する傾き測定を計算すること、
    前記傾き測定に基づいて複数のパーソナルナビゲーション軸に沿う傾き回復加速度成分を生成することであって、前記複数のパーソナルナビゲーション軸が、少なくとも鉛直軸と第1の水平軸と第2の水平軸とを含む、前記傾き回復加速度成分を生成すること、及び
    前記傾き回復加速度成分からの前記ストライド周波数成分を遮断することによってフィルタリングされた加速度成分を生成することであって、前記フィルタリングされた加速度成分が、鉛直加速度成分と、前記第1の水平軸に沿う第1の水平加速度成分と、前記第2の水平軸に沿う第2の水平加速度成分とを含む、前記加速度成分を生成すること、
    を含む、方法。
  15. 請求項14に記載の方法であって、前記推定姿勢を判定することが、式
    に基づいて事前姿勢を判定することであって、前記式において、Rxxは前記第1の水平加速度成分の自己共分散であり、Ryyは前記第2の水平加速度成分の自己共分散であり、Rxyは前記第1の水平加速度成分と前記第2の水平加速度成分の相互共分散である、前記事前姿勢を判定すること、
    事前前方向加速度成分を生成するため前記事前姿勢に応答して前記第1の水平軸加速度成分を回転回復すること、及び事前横方向加速度成分を生成するため前記事前姿勢に応答して前記第2の水平軸加速度成分を回転回復すること、
    前記事前前方向加速度成分と前記鉛直加速度成分との間の進み関係又は遅れ関係の一方を、前記事前前方向加速度成分と90度位相回転された鉛直加速度成分との相互共分散に基づいて検出すること、
    前記検出された関係に基づいて前記デバイスの動きの方向が前方向であるか又は後ろ方向であるかを判定すること、及び
    前記事前姿勢と前記デバイスの動きの前記方向とに基づいて前記デバイスの動きに関連する前記推定姿勢を判定すること、
    を含む、方法。
  16. 請求項15に記載の方法であって、前記前方向加速度成分と前記90度位相回転された鉛直加速度成分との間の相互共分散が正である場合、前記デバイスの動きの前記方向が前記前方向であり、前記前方向加速度成分と前記90度位相回転された鉛直加速度成分との間の前記相互共分散が負である場合、前記デバイスの動きの前記方向が前記後ろ方向である、方法。
  17. 請求項14に記載の方法であって、前記推定姿勢を判定することが、式
    に基づいて事前姿勢を判定することであって、前記式において、Rxxは前記第1の水平加速度成分の自己共分散であり、Ryyは前記第2の水平加速度成分の自己共分散であり、Rxyは前記第1の水平加速度成分と前記第2の水平加速度成分との相互共分散である、前記事前姿勢を判定すること、
    事前前方向加速度成分を生成するため前記事前姿勢に応答して前記第1の水平軸加速度成分を回転回復することであって、事前横方向加速度成分を生成するため前記事前姿勢に応答して前記第2の水平軸加速度成分を回転回復するように構成される、前記回転回復すること、
    前記事前前方向加速度成分と前記鉛直加速度成分の間の進み関係又は遅れ関係の一方を、前記事前前方向加速度成分と90度位相回転された鉛直加速度成分との相互共分散に基づいて検出すること、
    前記検出された関係に基づいて前記デバイスの動きの方向が前方向であるか又は後ろ方向であるかを判定すること、

    に基づいて品質メトリック因子を生成することであって、前記式において、Rfvは前方向加速度成分と前記鉛直加速度成分との間の相互共分散であり、Rffは前記前方向加速度成分の自己共分散であり、Rvvは前記鉛直加速度成分の自己共分散である、前記品質メトリック因子生成すること、及び
    前記事前姿勢、前記デバイスの動きの前記方向、及び前記品質メトリック因子に基づいて前記推定姿勢を判定すること、
    を含む、方法。
  18. 請求項17に記載の方法であって、前記推定姿勢が、式
    YawFiltn = Yawn×abs(YawQM)+YawFiltn-1×(1-abs(YawQM))
    に基づいて判定され、前記式において、YawFiltは時間tにおける推定姿勢であり、YawFiltn−1は時間tn−1における推定姿勢であり、Yawは、時間tにおける前記事前姿勢と前記デバイスの動きの前記方向とに基づいて判定される姿勢である、方法。
  19. 歩行者ナビゲーションのためのデバイスにおいて動作可能な方法であって、前記方法が、
    加速度計センサの複数の軸におけるデバイスの動きに関連する加速度成分を感知することであって、前記加速度成分がストライド周波数成分及びステップ周波数成分を含むこと、及び
    前記加速度計センサに対する前記デバイスの動きの推定姿勢を判定するために前記加速度成分の少なくとも一部を電子的に処理すること、
    を含み、
    前記電子的に処理することが少なくとも、
    前記加速度成分の前記ストライド周波数成分を遮断することによって前記加速度成分の前記ステップ周波数成分をフィルタ出力することと、
    前記デバイスの動きの横方向揺れに関連する前記推定姿勢における偏りを軽減するために、前記加速度成分の前記ステップ周波数成分に基づいて前記推定姿勢を判定することと、
    を含む、
    方法。
  20. 請求項19に記載の方法であって、前記電子的に処理することがさらに、式
    に基づいて事前姿勢を判定することであって、前記式において、Rxxは前記第1の水平加速度成分の自己共分散であり、Ryyは前記第2の水平加速度成分の自己共分散であり、Rxyは前記第1の水平加速度成分と前記第2の水平加速度成分との相互共分散である、前記事前姿勢を判定すること、
    事前前方向加速度成分を生成ため前記事前姿勢に応答して前記第1の水平軸加速度成分を回転回復すること、及び事前横方向加速度成分を生成するため前記事前姿勢に応答して前記第2の水平軸加速度成分を回転回復すること、
    前記事前前方向加速度成分と前記鉛直加速度成分との間の進み関係又は遅れ関係の一方を、前記事前前方向加速度成分と90度位相回転された鉛直加速度成分との相互共分散に基づいて検出すること、
    前記検出された関係に基づいて前記デバイスの動きの方向が前方向であるか又は後ろ方向であるかを判定すること、

    に基づいて品質メトリック因子を生成することであって、前記式において、Rfvは前方向加速度成分と前記鉛直加速度成分との間の相互共分散であり、Rffは前記前方向加速度成分の自己共分散であり、Rvvは前記鉛直加速度成分の自己共分散である、前記品質メトリック因子を生成すること、及び
    前記事前姿勢、前記デバイスの動きの前記方向、及び前記品質メトリック因子に基づいて前記推定姿勢を判定すること、
    を含む、方法。
JP2017500028A 2014-07-03 2015-07-06 歩行者ナビゲーションデバイス及び方法 Active JP6662842B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
US14/323,823 US10371528B2 (en) 2014-07-03 2014-07-03 Pedestrian navigation devices and methods
US14/323,823 2014-07-03
PCT/US2015/039244 WO2016004434A1 (en) 2014-07-03 2015-07-06 Pedestrian navigation devices and methods

Publications (2)

Publication Number Publication Date
JP2017526906A true JP2017526906A (ja) 2017-09-14
JP6662842B2 JP6662842B2 (ja) 2020-03-11

Family

ID=55016786

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017500028A Active JP6662842B2 (ja) 2014-07-03 2015-07-06 歩行者ナビゲーションデバイス及び方法

Country Status (5)

Country Link
US (1) US10371528B2 (ja)
EP (1) EP3189303B1 (ja)
JP (1) JP6662842B2 (ja)
CN (1) CN106574838B (ja)
WO (1) WO2016004434A1 (ja)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20160238408A1 (en) * 2015-02-18 2016-08-18 Plantronics, Inc. Automatic Determination of User Direction Based on Direction Reported by Mobile Device
US10041800B2 (en) * 2016-09-23 2018-08-07 Qualcomm Incorporated Pedestrian sensor assistance in a mobile device during typical device motions
CN107918350A (zh) * 2017-11-30 2018-04-17 陕西华恒水务集团有限公司 一种农用机械安全监控方法
CN108537101B (zh) * 2018-01-05 2022-03-25 浙江大学 一种基于状态识别的行人定位方法
CN109917441B (zh) * 2019-04-02 2024-05-07 河北工业大学 一种基于窄带物联网的运动物体姿态定位装置及方法
CN112568899A (zh) * 2019-09-30 2021-03-30 深圳市荣盛智能装备有限公司 一种人员姿态判断方法和系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060284979A1 (en) * 2005-06-09 2006-12-21 Sony Corporation Activity recognition apparatus, method and program
JP2011179869A (ja) * 2010-02-26 2011-09-15 Sanyo Electric Co Ltd ナビゲーション装置
US20120136573A1 (en) * 2010-11-25 2012-05-31 Texas Instruments Incorporated Attitude estimation for pedestrian navigation using low cost mems accelerometer in mobile applications, and processing methods, apparatus and systems
US20130190008A1 (en) * 2012-01-19 2013-07-25 University Of Southern California Physical activity monitoring and intervention using smartphone and mobile app
JP2013200162A (ja) * 2012-03-23 2013-10-03 Chiba Univ 小型姿勢センサ
JP2017506745A (ja) * 2014-05-09 2017-03-09 コーニンクレッカ フィリップス エヌ ヴェKoninklijke Philips N.V. 加速度計の方向を決定する方法及び装置

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6826477B2 (en) 2001-04-23 2004-11-30 Ecole Polytechnique Federale De Lausanne (Epfl) Pedestrian navigation method and apparatus operative in a dead reckoning mode
US9239376B2 (en) * 2010-10-08 2016-01-19 Telecommunication Systems, Inc. Doppler aided inertial navigation
IL180833A (en) * 2007-01-21 2012-10-31 Israel Aerospace Ind Ltd Pedestrian navigation system and method
US9062971B2 (en) 2008-03-06 2015-06-23 Texas Instruments Incorporated E-compass, tilt sensor, memory and processor with coarse detilting procedure
US8515707B2 (en) * 2009-01-07 2013-08-20 Sensor Platforms, Inc. System and method for determining an attitude of a device undergoing dynamic acceleration using a Kalman filter
EP2533692B1 (en) * 2010-02-11 2015-01-14 Koninklijke Philips N.V. Method and apparatus for determining a respiration signal
US20130085677A1 (en) * 2011-09-30 2013-04-04 Apple Inc. Techniques for improved pedometer readings
US10215587B2 (en) * 2012-05-18 2019-02-26 Trx Systems, Inc. Method for step detection and gait direction estimation
CN103505219B (zh) * 2012-06-20 2015-08-26 中国科学院电子学研究所 一种人体步态评测系统及方法
US8775128B2 (en) * 2012-11-07 2014-07-08 Sensor Platforms, Inc. Selecting feature types to extract based on pre-classification of sensor measurements
RU134633U1 (ru) 2013-05-08 2013-11-20 Федеральное государственное бюджетное образовательное учреждение высшего профессионального образования "Саратовский государственный технический университет имени Гагарина Ю.А." (СГТУ имени Гагарина Ю.А.) Устройство для персональной навигации и ориентации
CN103727959B (zh) 2013-12-31 2016-09-14 歌尔声学股份有限公司 计步方法及装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060284979A1 (en) * 2005-06-09 2006-12-21 Sony Corporation Activity recognition apparatus, method and program
JP2011179869A (ja) * 2010-02-26 2011-09-15 Sanyo Electric Co Ltd ナビゲーション装置
US20120136573A1 (en) * 2010-11-25 2012-05-31 Texas Instruments Incorporated Attitude estimation for pedestrian navigation using low cost mems accelerometer in mobile applications, and processing methods, apparatus and systems
US20130190008A1 (en) * 2012-01-19 2013-07-25 University Of Southern California Physical activity monitoring and intervention using smartphone and mobile app
JP2013200162A (ja) * 2012-03-23 2013-10-03 Chiba Univ 小型姿勢センサ
JP2017506745A (ja) * 2014-05-09 2017-03-09 コーニンクレッカ フィリップス エヌ ヴェKoninklijke Philips N.V. 加速度計の方向を決定する方法及び装置

Also Published As

Publication number Publication date
US10371528B2 (en) 2019-08-06
WO2016004434A1 (en) 2016-01-07
EP3189303B1 (en) 2023-05-10
CN106574838A (zh) 2017-04-19
US20160003622A1 (en) 2016-01-07
EP3189303A1 (en) 2017-07-12
CN106574838B (zh) 2020-10-20
JP6662842B2 (ja) 2020-03-11
EP3189303A4 (en) 2018-07-25

Similar Documents

Publication Publication Date Title
JP6662842B2 (ja) 歩行者ナビゲーションデバイス及び方法
EP2773920B1 (en) System and method for improving orientation data
EP2434256B1 (en) Camera and inertial measurement unit integration with navigation data feedback for feature tracking
CN107636420B (zh) 用于行人航位推算的技术
US11181379B2 (en) System and method for enhancing non-inertial tracking system with inertial constraints
CN104776846B (zh) 移动装置和移动装置上的估计用户的运动方向的方法
WO2016198009A1 (zh) 一种检测航向的方法和装置
CN107917707B (zh) 一种任意姿态下行人方向的确定方法、装置及电子设备
US10533874B2 (en) Inertial positioning and navigation device featuring a novel walk detection method
US9605966B2 (en) Method for estimating a trajectory orientation followed by a movement sensor carrier, corresponding device and computer program
Ayub et al. Pedestrian direction of movement determination using smartphone
WO2022179602A1 (zh) 导航信息的处理方法、装置、电子设备及存储介质
EP3227634B1 (en) Method and system for estimating relative angle between headings
CN116718153B (zh) 一种基于gnss和ins的形变监测方法及系统
CN111696159B (zh) 激光里程计的特征存储方法、电子设备和存储介质
US20160298972A1 (en) Travel direction information output apparatus, map matching apparatus, travel direction information output method, and computer readable medium
Kundra et al. The summary of indoor navigation possibilities considering mobile environment
CN115727871A (zh) 一种轨迹质量检测方法、装置、电子设备和存储介质
JP6653151B2 (ja) 進行方向推定システム
Drosescu et al. MEMS based device for steering wheel angle experimental measuring
JP2009098127A (ja) ナビゲーション装置
CN117109547A (zh) 一种井下寻北定向方法和装置
WO2024077237A1 (en) Methods and systems for robust heading estimation in pedestrian dead reckoning navigation
CN116046020A (zh) 零偏值确定方法及装置
CN117705097A (zh) 一种棱镜杆装置、地物碎部点测量方法、设备及介质

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20170105

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180629

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190820

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191119

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200108

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200109

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: 20200129

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200213

R150 Certificate of patent or registration of utility model

Ref document number: 6662842

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313117

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313117

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313117

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250