JP2020528560A - 磁場の測定から判定された方位を特徴付ける方法および装置 - Google Patents

磁場の測定から判定された方位を特徴付ける方法および装置 Download PDF

Info

Publication number
JP2020528560A
JP2020528560A JP2020504407A JP2020504407A JP2020528560A JP 2020528560 A JP2020528560 A JP 2020528560A JP 2020504407 A JP2020504407 A JP 2020504407A JP 2020504407 A JP2020504407 A JP 2020504407A JP 2020528560 A JP2020528560 A JP 2020528560A
Authority
JP
Japan
Prior art keywords
magnetic
magnetic field
orientation
calculation means
function
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
JP2020504407A
Other languages
English (en)
Other versions
JP7404227B2 (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 JP2020528560A publication Critical patent/JP2020528560A/ja
Application granted granted Critical
Publication of JP7404227B2 publication Critical patent/JP7404227B2/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
    • G01C17/00Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
    • G01C17/38Testing, calibrating, or compensating of compasses
    • 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/04Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
    • G01C21/08Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
    • 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/165Navigation; 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 combined with non-inertial navigation instruments
    • G01C21/1654Navigation; 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 combined with non-inertial navigation instruments with electromagnetic compass
    • 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/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation

Abstract

本発明は、磁場を少なくとも1つの磁力計によって測定し、前記測定から磁気方位を判定し、各々の磁気方位の測定について該測定により判定される前記方位の特性値を計算する処理を計算手段が実施する、方位を判定する方法であって、前記特性値は前記測定された磁場勾配のノルムの単調関数であり、前記特性値は前記方位の前記判定に使用されることを特徴とする方法に関する。【選択図】図3

Description

本発明は、一般的に言えば、磁気慣性技術に関する。
より正確には、本発明は、磁力計による方位の判定に関する。
特に、都市部または「屋内」、つまり建物内の測定の場合に有利に適用される。
従来、組み込みシステムの方位の計算には磁力計が使用されていた。
この場合、センサによって測定される磁場は、その水平成分について磁北を指す地球の磁場であるという仮説が立てられる。磁北の方向と地理的な北の方向の違い(磁赤緯と呼ばれる)は既知であり、表になっている。したがって、一般性を失うことなく、今後、磁北と地理的北とが統合され、磁力計が北と呼ばれるものを示すと見なされる。
通常、磁力計の測定値から方位を計算するために使用される判定方法は、
磁力計が提供する測定値とシステムの方位に関する情報とを関連付けするモデリングと、
実行された測定値に対するこの関係の関連性の特徴付けと、
に基づいている。
従来のアプローチでは、実装される計算は、測定値として磁場を使用するカルマン型フィルタリングであり、状態に含まれる方位を関連性の特性化の関数である測定ノイズでリセットすることを可能にする。
モデリングは、例えば、方程式
M=R(ψ,θ,φ)EARTH
により、測定された磁場Mに方位情報が含まれていることを記述することで構成される。
ここで、Rはオブジェクトの参照フレームから地球の慣性参照フレームへの移動を可能にする回転行列であり、ψ、θ、φはオイラー角であり、MEARTHは地球の磁場である。
この方程式の関連性は、測定の分散によって特徴付けられる。つまり、この等式の誤差は、期待値がゼロのガウス確率変数であると想定される。
この分散は、異なるノイズ(外部環境に関連付けられた動的ノイズと磁力計の測定ノイズ)を考慮するために、リセットに重み付けするカルマンゲインを自動的に計算するのに役立つ。
さらに別のアプローチでは、同じタイプのモデリングと特性評価とを使用した線形フィルタリングによる計算が実装される。
このアプローチでは、その関連性を特徴付けるのは、方程式のゲインの振幅の相対的な調整である。一般に、このゲインは手動で調整される。その場合、当業者は、モデリングの関連性の関数としてそれをどのように重み付けするかを知っているであろう。
したがって、これらの2つのアプローチでは、モデルの関連性を特徴付けるパラメータ(カルマンフィルタの場合はガウスノイズの分散、線形フィルタの場合はゲイン)は一般に、測定磁場に関係なく一定のパラメータである。
測定された磁場を考慮に入れたモデリングの関連性の特性化は、最近、例えば、出版物
− W.T.Faulkner、R.Alwood、W.T.David、およびJ.Bohlin、「2010年国際航海技術会議の議事録」、(サンディエゴ、カリフォルニア州)、の「imuおよび磁気コンパスを使用した屋内環境でのGPSで拒否された歩行者追跡」)、198〜204ページ、2010年1月、
−M.H.Afzal、V.Renaudin、およびG.Lachapelle、「歩行者のナビゲーション環境のための磁場ベースの方位推定」、「2011年屋内測位および屋内ナビゲーションに関する国際会議」、(ポルトガル、ギマランイス)、2011年9月、
で提案された。
しかし、それによって実施された特性は完全な満足を与えるものではない。
これは、特に磁場が著しく乱れている環境、特に、建物の電流や金属元素に起因する磁気乱れが地球の磁場に重畳される「屋内」または都市部の場合である。
本発明の一般的な目的は、特に非常に乱れた環境で使用されるモデリングの関連性のより良い特徴付けを可能にする解決策を提案することである。
特に、本発明は、磁場を少なくとも1つの磁力計によって測定し、前記測定から磁気方位を判定し、各々の磁気方位の測定について該測定により判定される前記方位の特性値を計算する処理を計算手段が実施する、方位を判定する方法であって、前記特性値は前記測定された磁場勾配のノルムの単調関数であり、前記特性値は前記方位の前記判定に使用されることを特徴とする方法を提案する。
特に、前記特性値は、勾配のノルム、特にノルムL2の単調関数であり、優先的に増加する(直接正の係数の線形関数の例が採用される)。
例えば、方位がますます乱れた場合に特性値がより低い値を有すると任意に判定される場合、前記特性値は勾配のノルムの減少関数であり得ることが理解されよう。
前記計算手段は、所与のサンプリング時刻について、
以前の前記サンプリング時刻に判定された前記方位の関数である方位予測を推定することと、
磁力計の測定から判定された磁気方位の関数として推定された前記予測方位をリセットすることと、を判定し、
前記リセットすることは、前記特性値の関数として判定され、そして、有利には、特性値の単調関数(特に増加)である。
したがって、前記リセットは、有利には、測定された磁場の勾配の関数、特に勾配のノルムの単調関数(単調関数の合成による)である。このように、環境が乱れるほど勾配が大きくなり、それにより方位の測定値が改ざんされるという事実が考慮される。
優先的な実施形態では、前記リセット中に、前記計算手段が、
2つのサンプリング時刻の間の磁気擾乱の変化モデルと、
前記擾乱の振幅のアプリオリ推定と、
の関数として前記リセットの前記振幅を推定する。
このように、処理は、2つのサンプリング時刻の間の磁気方位擾乱の変化を考慮し、連続するサンプリング時刻の場合の環境による擾乱の潜在的な空間相関を考慮する。
それから生じる計算は、従来技術よりも信頼性が高い。
特に、所与のサンプリング時刻k+1に対して、
計算手段は、
を計算することにより、関連付けされた方位擾乱を推定する。
ここで、
であり、
のガウス確率変数であり、
kは以前の前記サンプリング時刻であり、
α[k]は、前記磁気擾乱のアプリオリ振幅を表すパラメータであり、
は、擾乱の前記変化の前記期待値と分散の推定として前記計算手段によって
計算された2つのパラメータである。
前記計算手段は、前記磁場勾配の前記ノルムの線形関数として前記パラメータa[k]を推定してもよい。
前記パラメータ
は、たとえば前記計算手段によって、k+1およびkの時刻について前記磁力計の出力から直接判定される前記磁気方位間の差として、
を減算して計算される。
前記パラメータσは、2つの連続するサンプリング時刻の間の前記変位速度または前記変位の関数として推定されてもよい。
前記処理は、たとえば、状態が少なくともパラメータとして実方位および磁気方位擾乱(ψ,ψ(d))を有するカルマンフィルタリングを実施する。
前記方位予測は、慣性ユニットの1つまたはそれ以上のセンサの測定値の関数として判定されてもよい。
本発明は、さらに、磁気センサにより方位を判定するための装置であって、磁力計と、前記磁力計により測定された磁場から方位を計算する計算手段とを備え、前記計算手段が異なる連続サンプリング時刻について前述した方法の処理を実施することを特徴とする装置に関する。
また、少なくとも1つのそのような方位測定装置を含む磁気慣性航法システムを提案している。
そのようなシステムは、都市環境または建物内で有利に使用される。
本発明はまた、
コンピュータ上で実行されるときに前述の方法を実行するためのコード命令を含む、コンピュータプログラム製品と、
コンピュータプログラム製品がそのような方法を実行するためのコード命令を含む、コンピュータ機器によって読み取り可能な記憶手段と、
に関する。
本発明の他の特徴および利点は、純粋に例示的かつ非限定的であり、添付の図面に関して読まれるべきである以下の説明からより明らかになるであろう。
本発明による方法を実施するための機器の図である。 本発明による方法を実施する場合の例をより詳細に表す。 本発明の実施形態に従う方法の主要なステップを示す。
[総論−測定装置]
図1を参照すると、提案された測定装置は、たとえば、
で示す周囲磁場(通常、近くの金属物体によってわずかに変化する可能性のある地球の磁場)を移動する物体1の動きの推定に使用される。知られているように、磁場は3次元ベクトル場であり、つまり、3次元のベクトルを、物体が移動可能な各3次元点に関連付ける。
この物体1は、位置の知識が望まれる任意の可動物体、例えば、車輪付きの乗り物、無人機などであり得るが、歩行者でもあり得る。
物体1は、ケース2(支持体)内に複数の磁気測定センサ20、すなわち軸方向磁力計20を備えている。軸方向磁力計は、前記磁場の成分、すなわち、その軸に沿った前記磁力計20のレベルでの前記磁場ベクトル
の投影を測定することができる素子を意味すると解釈される。
より正確には、磁力計20はケース2と一体である。それらは、ケース2および地上基準フレーム内の物体1と実質的に同一の動きを有する。
好ましい方法では、物体1の基準フレームには、磁力計20がこの基準点に所定の位置を有する正規直交デカルト基準点が提供される。
図2では、ケース2は、取り付け手段23によって物体1(例えば、歩行者の手足)に固定されている。これらの取り付け手段23は、例えば、ブレスレット、例えば手足を把持し、統合的な関連付けを有効にする自己把持ストラップからなる。
明らかに、本発明は歩行者の動きの推定に限定されないが、人間が人間工学的に携帯する場合に必要なかさを非常に小さくできるので、そのような使用において特に有利である。
ケース2は、本方法の処理動作をリアルタイムで直接実施するための計算手段21(典型的にはプロセッサ)を含んでもよく、または、代わりに、測定値が、通信手段25を介して、モバイル端末(スマートフォン)3またはリモートサーバ4などの外部装置に送信されてもよいし、あるいは、代わりに、測定値が、例えばサーバ4で事後処理するためにローカルデータ記憶メモリ手段22(例えばフラッシュタイプメモリ)に記録されてもよい。
通信手段25は、短距離無線通信、例えばブルートゥース(登録商標)またはWi―Fi(特に、モバイル端末3を備えた実施形態では)を実装してもよく、さらには、長距離通信のためにモバイルネットワーク(通常はUMTS/LTE)に接続する手段であってもよい。通信手段25は、例えば、ローカルデータ記憶手段22からモバイル端末3またはサーバ4のデータ記憶手段にデータを転送するための有線接続(典型的にはUSB)であってもよいことに留意されたい。
「インテリジェンス」をホストするのがモバイル端末3(それぞれサーバ4)である場合、モバイル端末3は、これから説明する本方法の処理動作を実施するためのプロセッサなどの計算手段31(それぞれ41)を含む。使用される計算手段がケース2の計算手段21である場合、計算手段21は推定位置を送信するための通信手段25をさらに含み得る。例えば、ベアラの位置をモバイル端末3に送信して、ナビゲーション・ソフトウェア・インターフェースに位置を表示することができる。
ケース2、スマートフォン3、およびリモートサーバ4のそれぞれのデータ計算手段21、31、41は、方法に関係なく、アプリケーションに従って方法のステップのすべてまたは一部を実行することができる。
それらはそれぞれ、この目的のために、方法の実行のためのコード命令のシーケンスのすべてまたは一部が記憶される記憶手段を備えている。
[予測およびリセット]
計算手段は、一方で予測による方位値の推定値を計算し(ステップ101)、他方で誤差推定機能としてリセットを実行する(ステップ102)フィルタリング100を実施する(図3)。
特に、例えばジャイロメータによって与えられる角速度ωを知っている場合、ステップ101は、時刻k+1での方位ψk+1
と計算する。
ここで、ψは先行する時刻kでの方位であり、Δtはこれら2つのサンプリング時刻を分離する期間である。
リセット102は、磁力計20により実行された測定を考慮に入れる。
以下、与えられた時刻kに対する(磁力計の測定から得られた)磁気方位の測定は、
として、
と表記される。
通常、磁気方位は次の式
で与えられる。
ここで、MyおよびMxは、地上基準フレーム内の磁場の2つの水平成分であり、これらの2つの成分は、その慣性ユニットにより物体1に対して判定された姿勢の関数として計算される。
計算手段は、時刻k+1に対応するリセット方位
を、このときの方位推定ψk+1の和に等しいと計算し、有利には、
前の時刻kに関して計算または調整されたゲインKの関数、
予測方位ψk+1と測定値zψとの間の誤差Err(ψk+1,zψ)の推定値の関数、
であるリセットを計算する。
したがって、計算手段は、磁力計による測定から得られた磁気方位を使用して、
を計算することにより、状態、特に方位をリセットする。
通常、誤差Err(ψk+1,zψ)は、時刻k+1(リセット前)に推定された予測方位と、磁力計測定から得られた磁気方位zψとの単純な差である。
それにもかかわらず、特に非線形フィルタリングの場合には、他のエラー関数が可能である。
特に、リセットK.Err(ψk+1,zψ)、より具体的にはゲインKは、磁力計20によって測定された磁場勾配に有利に依存し得る。上述したように、ゲインKは優先的に勾配のノルムの単調関数、特に増加する関数である。
このように、磁場が大きく変化する場合、リセット補正は非常に重要であり、方位測定において重要なエラーを引き起こす可能性がある。
それにより得られたリセット方位値は、前記計算手段21、31、41によって記憶され、および/または処理の残りのために、および磁気慣性航法情報(線形速度、角速度、位置、方位など)の計算のために前記手段によって使用される。
また、リセット方位値は、計算手段によって、例えばそのスクリーンに表示される電話のインターフェース手段に送信されてもよい。
[環境に関連した擾乱の変化モデル]
環境に関連付けされた磁場の擾乱の推定により磁気方位zψの測定値が修正されるリセットの可能な計算の例は、以下で詳述される。
磁力計による測定から得られた磁気方位zψは、実際には次のように分類されると考えられる。
ここで、
ψは、判定しようとしている実際の見出しに対応し、
zψはガウス測定誤差に対応し、
ψ(d)(擾乱の「d」)は、環境に関連する磁気方位擾乱(通常、都市環境または建物内の金属インフラストラクチャおよび電気ケーブルに関連する擾乱)に対応する。
環境に関連付けされた磁気方位擾乱は、空間的に高度に相関している。環境の擾乱に関連する磁場は、実際には連続ベクトル場であり、2つの与えられた点AおよびBにおける磁場は、これらの2つの点AおよびBが空間内で隣接している場合、すべてより近くなる。
一実施形態では、環境に関連付けされた方位擾乱ψ(d)は、(時刻的、空間的相関、またはより複雑な)連続する2つのサンプリング時刻の間の磁場の擾乱に対して予想される変化相関を考慮に入れた定式化により計算手段によって推定される。
この推定は、変化ψに対してマルコフモデル(再帰フィルタで使用可能)を有効にするために構築されるとともに、
・(時刻的、空間的相関、またはより複雑)磁気方位擾乱の変化モデルを考慮することを可能にし、
・方位が観測可能なフィルタリングモデルの構築を可能にする(そうでない場合、方位推定器を構築する希望は失われる)。
提案された推定では、リセットの振幅は、2つのサンプリング時刻の間の磁気擾乱の変化モデルと擾乱の振幅のアプリオリ推定との関数として推定される。
本発明者らは、空間相関の場合(都市部または屋内での擾乱の場合)、時間ステップで区切られた2つのサンプリング時刻の間の擾乱の変化ψ(d)の適切な推定値は、有利には以下のようであることを発見(および数学的に検証)した。
ここで、
であり、
のガウス確率変数であり、
α[k]は、前記磁気擾乱のアプリオリ振幅を表すパラメータであり、
は、2つのサンプリング時刻の間の磁気方位擾乱の変化モデル(ガウス確率変数の形式)である確率変数の期待値と分散である。
ψ(d)は、磁力計のノイズを考慮した推定値である。
この推定値は、誤差計算のためにzψから差し引かれ、これは、ψk+1と(zψ−ψ(d)[k+1])との間で直接計算でき、または、その状態にψ(d)およびψの両方があるカルマン型フィルタリングに限定される。
[パラメータa[k]の判定]
パラメータa[k]は、磁気方位擾乱のアプリオリ振幅を表す。これは方位を特徴づけ、たとえば、単調関数の例である磁場勾配のノルムの線形関数として計算される。
たとえば、
として
a[k]=a+aN[k]
であり、つまり、ノルムL2である。ただし、ノルムL1、フロベニウスノルム、または他のノルムなど、他のノルムを使用することもできる。
およびaはフィルタリング処理の実装前に事前に固定された2つのパラメータであり、磁場が時刻kにある限り、
である。関数a[k]は、aが正の瞬間からノルムを増加させる。
あるいは、他の単調関数、たとえば勾配の成分の中から適切に選択されたパラメータの二次関数を使用することもできる。
このように、上記のように、リセット項K.Err(ψk+1,zψ)は、ゲインKの単調関数であり、それ自体が磁力計20によって測定される磁場勾配のノルムの単調関数であり、これによって、効率的な修正が可能になる。
パラメータa[k]を判定する他の方法も可能である。
特に、a[k]は、たとえば以下の出版物で提案されているような技術を実装することにより、地球の磁場のモデルと比較することでも判定できる。
「屋内の複数の磁力計の評価を使用した屋内磁場異常の評価」−M.H.Afzal、V.Renaudin、G.Lachapelle−2010年9月21日〜24日、第23回国際航法研究所衛星部門国際技術会議(ION GNSS 2010)の議事録。
ただし、パラメータa[k]が磁場勾配の関数である解決策では、より良い補正が可能になり、地球の磁場のモデルを必要としない。
ψ(d)の項は、最初の近似では無視できると見なされ、計算ではゼロと見なされる。
パラメータ
は、擾乱の変化の最も可能性の高い値を表す。
このパラメータは、例えば、短期的には正しいと想定されるジャイロメータを使用して計算される。擾乱の最も可能性の高い変化は、磁気方位測定値の変化とジャイロ方位の変化との差によって与えられる。
ここで、E[.]は数学的な期待値、ω[k]はジャイロ回転速度、dtはサンプリングピッチである。
従って、パラメータ
は、時刻k+1およびkの磁力計出力から直接判定された磁気方位の差として計算手段によって計算され、そこから予測回転ω[k]dtが減算される。
[パラメータσの判定]
パラメータσは、ステップkでの擾乱とステップk+1での擾乱との間の相関のイメージを表す。
磁気擾乱の空間的相関を考慮に入れるように、変位の速度(または類似の2つの連続するサンプリング時刻の間の変位)にインデックスを付けることを有利に選択することができる。
たとえば、
であり、cは調整係数である。
[他の実施形態]
別の実施形態では、磁気擾乱に関連する誤差によって損なわれる可能性が最も少ない、方位に依存する変数値を取得するために、異なる値の磁気方位が組み合わされる。
判定することが求められる変数は、たとえば、軌跡の一部の平均方位であり、他の方位依存変数は明らかに想定できる。
そのため、計算手段は、各サンプリングピッチkについて、測定された磁気方位zψ[k]の値と、勾配のノルムの単調関数として計算されたa[k]と呼ばれる磁気方位の特性評価の値を記録する。
たとえば、
である。
したがって、2つのサンプリング時刻k=kおよびk=kの間に定義された軌跡の部分の最も可能性の高い方向
は、最適化
の形で提示される。
ここで、
はノルム(L1、L2またはその他)である。
計算手段によって実施される最適化アルゴリズムは、任意の適切なタイプのもの、すなわち、勾配降下法、レーベンバーグ・マルカートアルゴリズム、またはメトロポリス・ヘイスティングスアルゴリズムであってもよい。
さらに、ノルムL2の場合、問題は最小二乗の形で提示され、計算手段は、
を直接判定する。
磁気擾乱が最も強い時刻kは、非加重平均よりも加重平均の影響がはるかに少ないため、この値は特性値によって加重されていない平均値よりもはるかに有利であることが容易に理解される。

Claims (15)

  1. 磁場を少なくとも1つの磁力計によって測定し、前記測定から磁気方位を判定し、各々の磁気方位の測定について該測定により判定される前記方位の特性値を計算する処理を計算手段が実施する、方位を判定する方法であって、前記特性値は前記測定された磁場勾配のノルムの単調関数であり、前記特性値は前記方位の前記判定に使用されることを特徴とする方法。
  2. 前記計算手段は、所与のサンプリング時刻について、
    以前の前記サンプリング時刻に判定された前記方位の関数である方位予測を推定することと、
    磁力計の測定から判定された磁気方位の関数として推定された前記予測方位をリセットすることと、を判定し、
    前記リセットすることは、前記特性値の関数として判定される、
    請求項1に記載の方法。
  3. 前記計算手段は、複数の測定された磁気方位および特性値の関数として、前記方位に依存する変数の値を判定する、請求項1または2に記載の方法。
  4. 前記リセット中に、前記計算手段が、
    2つのサンプリング時刻の間の磁気擾乱の変化モデルと、
    前記擾乱の振幅のアプリオリ推定と、
    の関数として前記リセットの前記振幅を推定する、請求項1〜3のいずれか一項に記載の方法。
  5. 前記計算手段は、所与のサンプリング時刻k+1について、
    を計算することにより、関連付けされた方位擾乱を推定し、
    であり、
    のガウス確率変数であり、
    kは以前の前記サンプリング時刻であり、
    a[k]は、前記磁気擾乱のアプリオリ振幅を表すパラメータであり、
    は、擾乱の前記変化の前記期待値と分散の推定として前記計算手段によって計算された2つのパラメータである、請求項2に記載の方法。
  6. 前記計算手段は、前記磁場勾配の前記ノルムの線形関数として前記パラメータa[k]を推定する、請求項5に記載の方法。
  7. 前記パラメータ
    は、ω[k]をジャイロ回転速度、dtをサンプリングピッチとして、k+1およびkの時刻について前記磁力計の出力から直接判定される前記磁気方位間の差として前記計算手段によって予測方位変化(ω[k]dt)を減算して計算される、請求項5または6に記載の方法。
  8. 前記パラメータσは、2つの連続するサンプリング時刻の間の前記変位速度または前記変位の関数として推定される、請求項5〜7のいずれか一項に記載の方法。
  9. 前記処理は、状態が少なくともパラメータとして実方位および磁気方位擾乱(ψ,ψ(d))を有するカルマンフィルタリングを実施する、請求項5〜8のいずれか一項に記載の方法。
  10. 前記方位予測は、慣性ユニットの1つまたはそれ以上のセンサの測定値の関数として判定される、請求項1〜9のいずれか一項に記載の方法。
  11. 磁気センサにより方位を判定するための装置であって、磁力計と、前記磁力計により測定された磁場から方位を計算する計算手段とを備え、前記計算手段が異なる連続サンプリング時刻について請求項1〜10のいずれか一項に記載の方法の処理を実施することを特徴とする装置。
  12. 請求項11に記載の少なくとも1つの磁場測定装置を備えた磁気慣性航法システム。
  13. 請求項12に記載のシステムの、都市環境または建物内の用途での使用。
  14. コンピュータ上で実行されるときに請求項1〜10のいずれか一項に記載の磁場測定方法を実行するためのコード命令を含む、コンピュータプログラム製品。
  15. コンピュータプログラム製品が請求項1〜10のいずれか一項に記載の磁場測定方法を実行するためのコード命令を含む、コンピュータ機器によって読み取り可能な記憶手段。
JP2020504407A 2017-07-28 2018-07-27 磁場の測定から判定された方位を特徴付ける方法および装置 Active JP7404227B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
FR1757220 2017-07-28
FR1757220A FR3069634B1 (fr) 2017-07-28 2017-07-28 Procede et dispositif de caracterisation d'un cap determine a partir de la mesure du champ magnetique
PCT/FR2018/051940 WO2019020961A1 (fr) 2017-07-28 2018-07-27 Procédé et dispositif de caractérisation d'un cap déterminé à partir de la mesure du champ magnétique

Publications (2)

Publication Number Publication Date
JP2020528560A true JP2020528560A (ja) 2020-09-24
JP7404227B2 JP7404227B2 (ja) 2023-12-25

Family

ID=60382327

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020504407A Active JP7404227B2 (ja) 2017-07-28 2018-07-27 磁場の測定から判定された方位を特徴付ける方法および装置

Country Status (7)

Country Link
US (1) US11415420B2 (ja)
EP (1) EP3658853A1 (ja)
JP (1) JP7404227B2 (ja)
KR (1) KR102547926B1 (ja)
CN (1) CN111183335B (ja)
FR (1) FR3069634B1 (ja)
WO (1) WO2019020961A1 (ja)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114046785A (zh) * 2021-11-10 2022-02-15 广东微电科技有限公司 磁探测信号线性噪声滤波方法及系统、计算机可读存储介质、磁导航传感器、agv小车
FR3137764A1 (fr) 2022-07-08 2024-01-12 Sysnav Procédé de recalage d’une attitude fournie par un système de navigation à l’estime au moyen d’un système de positionnement relatif

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016061766A (ja) * 2014-09-22 2016-04-25 カシオ計算機株式会社 電子機器及びセンサ較正方法、センサ較正プログラム
JP2016061762A (ja) * 2014-09-22 2016-04-25 カシオ計算機株式会社 電子機器及びセンサ較正方法、センサ較正プログラム

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04238221A (ja) * 1991-01-21 1992-08-26 Sumitomo Electric Ind Ltd 方位検出装置
EP2264485A1 (en) * 2009-06-04 2010-12-22 Tracedge Method for analysing moving object continuous trajectory based on sampled GPS position
CN102252689A (zh) * 2010-05-19 2011-11-23 北京国浩传感器技术研究院(普通合伙) 一种基于磁传感器的电子罗盘校准方法
CN202177381U (zh) * 2011-05-06 2012-03-28 微迈森惯性技术开发(北京)有限公司 运动姿态数据获取装置与人体运动姿态追踪系统
JP5061264B1 (ja) * 2012-03-23 2012-10-31 国立大学法人 千葉大学 小型姿勢センサ
JP2014089113A (ja) 2012-10-30 2014-05-15 Yamaha Corp 姿勢推定装置及びプログラム
US20140297212A1 (en) * 2013-04-02 2014-10-02 Kionix, Inc. Systems and Methods for Compensating for a Misalignment Angle Between an Accelerometer and a Magnetometer
CN103994766A (zh) * 2014-05-09 2014-08-20 北京航空航天大学 一种抗gps失效固定翼无人机定向方法
WO2017013657A1 (en) * 2015-07-21 2017-01-26 Israel Aerospace Industries Ltd. Gradiometer system and method
US9958274B2 (en) 2015-12-29 2018-05-01 Fujitsu Limited Magnetic field based location determination
CN106017459B (zh) * 2016-05-19 2019-03-19 极翼机器人(上海)有限公司 一种抗磁干扰的方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016061766A (ja) * 2014-09-22 2016-04-25 カシオ計算機株式会社 電子機器及びセンサ較正方法、センサ較正プログラム
JP2016061762A (ja) * 2014-09-22 2016-04-25 カシオ計算機株式会社 電子機器及びセンサ較正方法、センサ較正プログラム

Also Published As

Publication number Publication date
EP3658853A1 (fr) 2020-06-03
CN111183335A (zh) 2020-05-19
CN111183335B (zh) 2022-02-11
WO2019020961A1 (fr) 2019-01-31
KR102547926B1 (ko) 2023-06-26
FR3069634A1 (fr) 2019-02-01
US11415420B2 (en) 2022-08-16
KR20200037333A (ko) 2020-04-08
JP7404227B2 (ja) 2023-12-25
US20200208980A1 (en) 2020-07-02
FR3069634B1 (fr) 2021-06-11

Similar Documents

Publication Publication Date Title
US10304200B2 (en) Techniques for accurate pose estimation
US20160238395A1 (en) Method for indoor and outdoor positioning and portable device implementing such a method
Panyov et al. Indoor positioning using Wi-Fi fingerprinting pedestrian dead reckoning and aided INS
JP2019120587A (ja) 測位システム及び測位方法
JP7404227B2 (ja) 磁場の測定から判定された方位を特徴付ける方法および装置
US20130110451A1 (en) State estimation apparatus
CN111148966B (zh) 一种用磁传感器确定航向的方法和设备
Qian et al. Optical flow based step length estimation for indoor pedestrian navigation on a smartphone
JP2013122384A (ja) カルマンフィルタ、及び、状態推定装置
US11519728B2 (en) Method for estimating the movement of an object moving in a magnetic field
Qian et al. Optical flow-based gait modeling algorithm for pedestrian navigation using smartphone sensors
CN111133274B (zh) 用于估计在环境和磁场中运动的对象的运动的方法
JPWO2019020962A5 (ja)
CN110579212B (zh) 室内定位方法及装置
CN116793340B (zh) 一种无人机自动着陆导航方法、装置及电子设备
Kuusniemi et al. Evaluation of Bayesian approaches for multi-sensor multi-network seamless positioning
Shoushtari et al. L5in+: From an analytical platform to optimization of deep inertial odometry
CN114322991A (zh) 设备的姿态检测方法、装置、电子设备及计算机存储介质
KR20140095286A (ko) 위치 추적 장치 및 위치 추적 방법

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210611

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220531

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220705

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221005

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230221

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230510

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230606

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230904

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230919

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20231106

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20231213

R150 Certificate of patent or registration of utility model

Ref document number: 7404227

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150