(57)【要約】  本発明は、周囲磁場中を移動する物体（１）のジャイロメータ（１１）を較正する方法に関し、本方法は：（ａ）ジャイロメータ（１１）による、測定角速度、及び前記物体（１）に固定された磁気測定手段（２０）による磁場の少なくとも２つの成分の取得のステップと；（ｂ）物体（１）の推定角速度及び磁場成分の少なくとも１つの第１の磁気方程式によって定義される第１の式を最小化するジャイロメータ（１１）の少なくとも１つの較正パラメータの値の決定のステップであって、推定角速度は、測定角速度及び較正パラメータの関数であり、少なくとも１つの第１の磁気方程式は、磁場が均一かつ定常と仮定する、ステップとを含むことを特徴する。
2021527213.tif 000002
【特許請求の範囲】
【請求項１】
周囲磁場中を移動する物体のジャイロメータを較正する方法であって、前記方法は：
（ａ）取得のステップであって、
−  前記ジャイロメータによる、前記物体の測定角速度の、及び
−  前記物体に固定された磁気測定手段による、前記磁気測定手段の周りの、前記磁場の及び／又は前記磁場のｉ次の微分の少なくとも２つの成分の、
取得のステップと；
（ｂ）データ処理手段による、前記物体の推定角速度並びに前記磁場及び／又は前記磁場のｉ次の微分の前記成分の少なくとも１つの第１の磁気方程式によって定義される第１の式を最小化する前記ジャイロメータの少なくとも１つの較正パラメータの値を決定するステップであって、
−  前記物体の前記推定角速度は、前記測定角速度及び前記ジャイロメータの較正パラメータの関数であり、
−  前記少なくとも１つの第１の磁気方程式は、前記磁場が前記磁気測定手段の周囲で均一かつ定常と仮定する、
決定するステップと
（ｃ）前記較正パラメータ上の誤差を表すパラメータを推定するステップと、
を含む、方法。
【請求項２】
前記物体の前記推定角速度ω（ｅｓｔｉｍａｔｉｏｎ）ｇｙｒｏは、モデル
【数１】
2021527213.tif 000056
によって前記測定角速度ω（ｍｅａｓｕｒｅｍｅｎｔ）ｇｙｒｏにリンクされ、Ｄ及びｂｇｙｒｏは、前記ジャイロメータの前記較正パラメータである、
請求項１に記載の方法。
【請求項３】
前記誤差を表す前記パラメータが所定の閾値よりも大きい場合、前記データ処理手段による、前記物体の前記推定角速度並びに前記磁場及び／又は前記磁場のｉ次の微分の前記成分の少なくとも１つの第２の磁気方程式によって定義される第２の式を最小化する前記ジャイロメータの前記少なくとも１つの較正パラメータの値を再決定するステップ（ｄ）をさらに含み、前記少なくとも１つの第２の磁気方程式は、前記磁場が前記磁気測定手段の周りで定常であると仮定する、
請求項１又は２に記載の方法。
【請求項４】
前記ステップ（ｄ）は、追加の取得手段による、前記物体の測定線速度の取得を含み、
前記少なくとも１つの第２の磁気方程式もまた、前記測定線速度上にある、
請求項３に記載の方法。
【請求項５】
前記較正パラメータ上の誤差を表す前記パラメータを新たに推定するステップ（ｅ）を含む、
請求項４に記載の方法。
【請求項６】
前記較正パラメータ上の誤差を表す前記パラメータは、前記較正パラメータの決定された前記値について計算された、前記第１の式の、又は適用可能な場合には前記第２の式の、前記値の関数である、
請求項１乃至５のいずれか１項に記載の方法。
【請求項７】
前記ステップ（ｃ）、及び適用可能な場合には前記ステップ（ｅ）は、前記較正パラメータ上の誤差を表す前記パラメータ及び前記ジャイロメータの最後の較正からの継続時間の値に従って、累積誤差間隔を決定するステップを含み、前記所定の閾値は、前記累積誤差間隔に依存する、
請求項３乃至６のいずれか１項に記載の方法。
【請求項８】
前記ステップ（ｂ）、及び適用可能な場合には前記ステップ（ｄ）は、再帰フィルタ又は最適化の実施を含む、
請求項１乃至７のいずれか１項に記載の方法。
【請求項９】
前記ステップ（ａ）で取得された前記磁場及び／又は前記磁場のｉ次の微分の前記成分は測定成分であり、前記第１の磁気方程式及び適用可能な場合には前記第２の磁気方程式によって使用される成分は、前記測定成分及び前記磁気測定手段の較正パラメータの関数としての推定成分であり、前記ステップ（ｂ）及び適用可能な場合には前記ステップ（ｄ）はまた、前記磁気測定手段の少なくとも１つの較正パラメータの値を決定するステップを含む、
請求項１乃至８のいずれか１項に記載の方法。
【請求項１０】
前記磁気測定手段は、三軸磁力計であり、前記磁場の前記推定成分Ｍ（ｅｓｔｉｍａｔｉｏｎ）は、モデル
【数２】
2021527213.tif 000057
による前記測定成分Ｍ（ｍｅａｓｕｒｅｍｅｎｔ）にリンクされ、Ａ及びｂｍａｇｎｅｔｏは前記磁気測定手段の前記較正パラメータである、
請求項９に記載の方法。
【請求項１１】
前記第１の磁気方程式は
【数３】
2021527213.tif 000058
の形態であり、適用可能な場合には、前記第２の磁気方程式は
【数４】
2021527213.tif 000059
の形態であり、∇ｎＭは前記磁場のｎ次の微分、ωは前記角速度、Ｖは前記線速度、ｆｎ及びｇｎは所定の関数である、
請求項１乃至１０のいずれか１項に記載の方法。
【請求項１２】
前記第１の磁気方程式は
【数５】
2021527213.tif 000060
であり、該当する場合、前記第２の磁気方程式は
【数６】
2021527213.tif 000061
である、
請求項１１に記載の方法。
【請求項１３】
前記第１の式は
【数２２】
2021527213.tif 000062
の関数であり、オプションの前記第２の式は
【数２０】
2021527213.tif 000063
の関数である、
請求項１１又は１２に記載の方法。
【請求項１４】
前記較正パラメータ上の誤差を表す前記パラメータは、所与の時間間隔にわたる
【数９】
2021527213.tif 000064
若しくは
【数１０】
2021527213.tif 000065
の平均、又は前記磁場及び／又は前記磁場のｉ次の微分の前記成分の空間勾配のすべて若しくは一部である、
請求項６乃至１３のいずれか１項に記載の方法。
【請求項１５】
前記データ処理手段によって、前記物体の前記測定角速度、前記磁場及び／又は前記磁場のｉ次の微分の前記成分、及び／又は前記物体の任意の測定線速度、及び較正パラメータの値に従って、前記物体の運動を推定するステップ（ｆ）を含み、前記物体の向きは、前記ステップ（ｆ）において、前記物体の前記測定角速度及び前記較正パラメータの値の関数としてのみ推定される、
請求項１乃至１４のいずれか１項に記載の方法。
【請求項１６】
周囲磁場中を移動する物体であって、前記物体の測定角速度を取得するように構成されるジャイロメータと、前記磁場及び／又は前記磁場のｉ次の微分の少なくとも２つの成分を取得するように構成される磁気測定手段とを有し、前記物体は、データ処理手段であって：
−  前記物体の推定角速度並びに前記磁場及び／又は前記磁場のｉ次の微分の前記成分に関する少なくとも１つの第１の磁気方程式によって定義される第１の式を最小化する前記ジャイロメータの少なくとも１つの較正パラメータの値を決定するように構成され、
〇  前記物体の前記推定角速度は、前記測定角速度と前記ジャイロメータの前記較正パラメータの関数であり、
〇  前記少なくとも１つの第１の磁気方程式は、前記磁場が前記磁気測定手段の周囲で均一かつ定常であると仮定し、
前記較正パラメータ上の誤差を表すパラメータを推定するように構成される、
データ処理手段をさらに有する、
物体。
【請求項１７】
前記物体は、前記物体の測定線速度を取得するように構成される追加の取得手段をさらに有し、前記データ処理手段はさらに、誤差を表す前記パラメータが所定の閾値よりも大きい場合、前記物体の前記推定角速度ならびに前記磁場及び／又は前記磁場のｉ次の微分の前記成分に関する少なくとも１つの第２の磁気方程式によって定義される第２の式を最小化する前記ジャイロメータの少なくとも１つの較正パラメータの値を再決定するように構成され、前記少なくとも１つの第２の磁気方程式は、前記磁場が前記磁気測定手段の周りで定常であると仮定している、
請求項１６に記載の物体。
【請求項１８】
前記物体は、車輪を有する車両であり、前記追加の取得手段は、前記車両の前記車輪に取り付けられた少なくとも２つの走行距離計である、
請求項１７に記載の物体。
【請求項１９】
コンピュータ上で実行されるとき、請求項１乃至１５のいずれか１項に記載のジャイロメータを較正する方法を実行するためのコード命令を含むコンピュータプログラム製品。
【請求項２０】
コンピュータ装置の一部によって読取可能な記憶手段であって、前記記憶手段のコンピュータプログラム製品が請求項１乃至１５のいずれか１項に記載のジャイロメータを較正する方法を実行するためのコード命令を含む、記憶手段。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ＧＮＳＳなしのナビゲーションに関する。
【０００２】
より正確には、本発明は、磁力計に固定されたジャイロメータを較正する方法に関する。
【背景技術】
【０００３】
今日では、ＧＮＳＳ（グローバルナビゲーション衛星システム（Global  Navigation  Satellite  System）、例えばGPS）を介して又は無線通信ネットワーク（放射ターミナル、ｗｉｆｉネットワークなどを用いた三角測量）を使用して車両の位置を追跡するのが一般的である。
【０００４】
これらの方法は、情報のアベイラビリティと精度を保証することができず、一方と他方とが、ソースと受信機との間の任意のマスキングによって影響を受けるため、非常に制限される。また、それらは、利用できないことがあり、自発的にスクランブルさえされることがあるＧＮＳＳのための衛星などの外部技術に依存している。
【０００５】
代替的には、「自律」方法が、例えば、慣性又は磁気慣性ユニットのために、車両の相対変位を任意の環境で追跡することも知られている。「相対変位」とは、初期化時の点及びデータマーカに対する空間における車両の軌跡を意味する。軌跡に加えて、これらの方法はまた、同じ初期マーカに対して車両の向きを得ることを可能にする。
【０００６】
ナビゲーションクラス慣性ユニットは、少なくとも三軸配置を持つ３つの加速度計と３つのジャイロメータから形成される。典型的には、ジャイロメータはマーカを「保持」し、加速度計の測定値の二重時間積分は、運動を推定することを可能にする。
【０００７】
特に、戦闘機や民間航空機、潜水艦、艦艇などのナビゲーションのような複雑な用途で実施されるような従来の慣性航法を使用できるようにするためには、非常に精密なセンサを使用する必要があることが知られている。実際、加速度測定値の二重時間積分は、加速度における一定誤差が、時間の二乗に比例して増加する位置の誤差を生じることを意味する。
【０００８】
代替的には、キャリアのマーカ内の速度ベクトル情報が、外部ソース（車両の走行距離測定、船舶のログ、航空機のピトー管）によって提供され得る場合、キャリアの向き、特にその方位を知ることが可能なときに、キャリアの軌道を得ることが可能であることが知られている。
【０００９】
一定の数の場合には、初期方位は既知であり（慣性装置の初期「アライメント」）、慣性（例えば、磁気）以外のセンサによって得ることができるか、又は慣性センサが地上回転を正確に測定することを可能にする場合には、慣性センサから直接導き出すことができる。
【００１０】
低コストのセンサを用いて作業することが望ましい場合の困難は、キャリアの配向情報、特に地上車両の方位情報を可能な限り良好に維持するような方法で、それらの誤差パラメータを連続的に較正することによってそれらの性能を「増加」させることである。
【００１１】
従って、磁気測定を使用してジャイロメータを較正することが、この文脈で提案された。
【００１２】
特許文献１は、２つの測定点間の磁場の変化が、ジャイロメータの積分によって予測される姿勢の変化に対応するかどうかを検査することを提案している。しかし、磁気測定／加速度測定は信頼できると仮定しており、これは扱いづらい。実際には、次のようなことが観察される：
−  周囲の磁場は常に均一且つ定常とは限らない；
−  近傍の金属要素（例えば、ボディワーク）又は磁石は、磁気測定に影響を及ぼす（軟鉄及び硬鉄のタイプの効果）。特許文献２も参照されたい。
−  磁力計を正確に較正するために、可観測性を得るために「誤差モデルを励起する」ように、磁力計を最大の空間方位に配置する必要がある。この問題は、手で持ち運ぶことができ、あらゆる方向に回すことができる装置の場合に容易に解決される。例えば、特許文献３を参照）。磁力計が車両に装着されている場合、次の制限がある：
・  車両の典型的な走行の間に、ロールとピッチがわずかにゼロから逸脱するという事実による。
・  ボディが磁化される、又は車両が積載されるという事実により、これは、較正がもはや適切でなくなる可能性があることを意味する；これは、定期的な再較正が必要となる。
【００１３】
特許文献４は、磁気コンパスとジャイロメータを有するスマートフォンタイプのデバイスにより的確に関連し、磁気外乱の問題に言及している。本特許文献４は、むしろ、ジャイロメトリックデータを用いた磁気コンパスの較正を目的とするが、出発点として磁気加速度計測の四元数を取り、この四元数から再較正角速度ω＝２ｑ−１ｑ・を得ることによって、逆（すなわち、磁気データを用いたジャイロメータの較正）も提案する。しかしながら、磁気計測／加速度計測測定が信頼できるという仮定は依然として成り立っており、逆の場合には、この状況が続く限り、ジャイロメータのバイアスを更新しないか、又はメモリに記憶されたデフォルトの四元数を使用することを単純に提案する。
【００１４】
結果の優れた品質を可能にし、かつ限定的でない、物体の運動を推定する目的のために、物体のジャイロメータを較正するための新しい方法を有することが望ましい。
【先行技術文献】
【特許文献】
【００１５】
【特許文献１】US2012／0116716
【特許文献２】US2004／0123474
【特許文献３】FR1757082
【特許文献４】US2011／0178707
【発明の概要】
【００１６】
したがって、本発明は、第１の態様によれば、周囲磁場中を移動する物体のジャイロメータを較正する方法に関し、その方法は、以下のステップを含むことを特徴とする：
（ａ）取得のステップであって、
−  ジャイロメータによる、物体の測定角速度の、及び
−  前記物体に固定された磁気測定手段による、磁気測定手段の周りの、磁場の及び／又は磁場のｉ次の微分の少なくとも２つの成分の、
取得のステップと；
（ｂ）データ処理手段による、物体の推定角速度並びに磁場及び／又は磁場のｉ次の微分の成分の少なくとも１つの第１の磁気方程式によって定義される第１の式を最小化するジャイロメータの少なくとも１つの較正パラメータの値を決定するステップであって、
−  物体の推定角速度は、測定された角速度及びジャイロメータの較正パラメータの関数であり、
−  少なくとも１つの第１の磁気方程式は、磁場が磁気測定手段の周囲で均一かつ定常と仮定する、
決定するステップ。
【００１７】
他の有利かつ非限定的な特徴によれば：
・  物体の推定角速度ω（ｅｓｔｉｍａｔｉｏｎ）ｇｙｒｏは、モデル
【数１】
2021527213.tif 000003
によって測定角速度ω（ｍｅａｓｕｒｅｍｅｎｔ）ｇｙｒｏにリンクされ、ここでＤ及びｂｇｙｒｏは、ジャイロメータの較正パラメータである；
・  本方法はさらに、較正パラメータ上の誤差を表すパラメータを推定するステップ（ｃ）を含む；
・  本方法はさらに、誤差を表す前記パラメータが所定の閾値よりも大きい場合、取得追加手段によって物体の測定線速度を取得し、データ処理手段による、物体の推定角速度並びに測定線速度並びに磁場及び／又は前記磁場のｉ次の微分の成分の少なくとも１つの第２の磁気方程式によって定義される第２の式を最小化するジャイロメータの少なくとも１つの較正パラメータの値を再決定するステップ（ｄ）を含み、少なくとも１つの第２の磁気方程式は、磁場が前記磁気測定手段の周りで定常であると仮定する、
・  本方法は、較正パラメータ上の誤差を表す前記パラメータの新たな推定のステップ（ｅ）を含む；
・  較正パラメータ上の誤差を表す前記パラメータは、較正パラメータの決定された値について計算された、前記第１の式の値、又は適用可能な場合には前記第２の式の値の関数である；
・  ステップ（ｃ）、及び適用可能な場合にはステップ（ｅ）は、較正パラメータ上の誤差を表す前記パラメータ及びジャイロメータの最後の較正からの継続時間の値に従って、累積誤差間隔を決定するステップを含み、前記所定の閾値は、前記累積誤差間隔に依存する；
・  ステップ（ｂ）、及び適用可能な場合にはステップ（ｄ）は、再帰フィルタ又は最適化の実施を含む；
・  ステップ（ａ）で取得された磁場及び／又は磁場のｉ次の微分の成分は測定成分であり、前記第１及び第２の磁気方程式によって使用される成分は、測定成分及び磁気測定手段の較正パラメータの関数としての推定成分であり、ステップ（ｂ）及び適用可能な場合にはステップ（ｄ）はまた、磁気測定手段の少なくとも１つの較正パラメータの値の決定を含む；
・  磁気測定手段は、三軸磁力計であり、磁場の推定成分Ｍ（ｅｓｔｉｍａｔｉｏｎ）は、モデル
【数２】
2021527213.tif 000004
による測定成分Ｍ（ｍｅａｓｕｒｅｍｅｎｔ）にリンクされ、ここでＡ及びｂｍａｇｎｅｔｏは磁気測定手段の較正パラメータである；
・  第１の磁気方程式は
【数３】
2021527213.tif 000005
の形態であり、適用可能な場合には、第２の磁気方程式は
【数４】
2021527213.tif 000006
の形態であり、ここで、∇ｎＭは磁場のｎ次微分、ωは角速度、Ｖは線速度、ｆｎ及びｇｎは所定の関数である；
・  第１の磁気方程式は
【数５】
2021527213.tif 000007
であり、該当する場合、第２の磁気方程式は
【数６】
2021527213.tif 000008
である； 
・  第１の式は
【数７】
2021527213.tif 000009
の関数であり、オプションの第２の式は
【数８】
2021527213.tif 000010
の関数である。
・  較正パラメータ上の誤差を表す前記パラメータは、所与の時間間隔にわたる
【数９】
2021527213.tif 000011
若しくは
【数１０】
2021527213.tif 000012
の平均、又は磁場の及び／又は磁場のｉ次の微分の前記成分の空間勾配のすべて若しくは一部である；
・  本方法は、前記物体の測定角速度、前記磁場及び／又は前記磁場のｉ次の微分の成分、及び／又は前記物体の測定線速度、及び前記物体の測定線速度に従って前記物体（１）の運動をデータ処理手段によって推定するステップ（ｆ）を含み、車両の向きは、ステップ（ｆ）において、車両の測定角速度及び較正パラメータの値の関数としてのみ推定される。
【００１８】
第２の態様によれば、周囲磁場中を移動する物体であって、前記物体の測定角速度を取得するように構成されるジャイロメータと、磁場及び／又は磁場のｉ次の微分の少なくとも２つの成分を取得するように構成される磁気測定手段とを有し、物体は、データ処理手段であって：
−  物体の推定角速度並びに磁場及び／又は磁場のｉ次の微分の成分に関する少なくとも１つの第１の磁気方程式によって定義される第１の式を最小化するジャイロメータの少なくとも１つの較正パラメータの値を決定するように構成されるデータ処理手段をさらに有することを特徴とし、
〇  物体の推定角速度は、測定角速度とジャイロメータの較正パラメータの関数であり、
〇  少なくとも１つの第１の磁気方程式は、磁場が磁気測定手段の周囲で均一かつ定常であると仮定している。
【００１９】
他の有利かつ非限定的な特徴によれば：
・  物体は、物体の測定線速度を取得するように構成される追加の取得手段をさらに含み、データ処理手段はさらに：
−  較正パラメータ上の誤差を表すパラメータを推定し；
−  誤差を表す前記パラメータが所定の閾値よりも大きい場合、物体の推定角速度ならびに磁場及び／又は磁場のｉ次の微分の成分に関する少なくとも１つの第２の磁気方程式によって定義される第２の式を最小化するジャイロメータの少なくとも１つの較正パラメータの値を再決定するように、構成され、少なくとも１つの第２の磁気方程式は磁場が磁気測定手段の周りで定常であると仮定している；
・  物体は、車輪を有する車両であり、追加の取得手段は、車両の車輪に取り付けられた少なくとも２つの走行距離計である。
【００２０】
第３の態様及び第４の態様によると、ジャイロメータを較正するための本発明の第１の態様による方法の実行のためのコード命令を含むコンピュータプログラム製品と；コンピュータプログラム製品が、ジャイロメータを較正する第１の態様による方法の実行のためのコード命令を含む、コンピュータ装置の一部によって読取可能な記憶手段とが提案される。
【図面の簡単な説明】
【００２１】
本発明の他の特徴及び利点は、好ましい実施形態の以下の説明を読むときに現れるものとする。この説明は、添付の図面を参照して、以下に示す。
【００２２】
【図１】本発明による方法の実装のための車両アーキテクチャの例を示す。
【図２】本発明による方法の好ましい実施形態のステップを示す図である。
【発明を実施するための形態】
【００２３】
アーキテクチャ
【００２４】
図１を参照すると、本方法は、Ｍとして記述される、周囲磁場（典型的には、地球磁場（該当する場合は近傍の金属物体によって変更される））中を移動する物体１のジャイロメータ１１の較正を可能にする。既に説明したように、磁場は、三次元空間におけるベクトル場であり、すなわち、物体１が移動可能である各三次元点に三次元ベクトルを関連付ける。
【００２５】
この物体１は、位置の知識が望まれる任意の移動可能な物体、例えば、車両、特に、車輪を備えた車両、ドローン等であるが、人又はこの人の人体又は身体の一部（手、頭部等）でもよい。
【００２６】
物体１は、ジャイロメータ１１及び磁気測定手段２０を備える。手段２０及びジャイロメータ１１は、物体１に、例えば、車両の場合にはボディワークに固定され、概して物体１の基準フレーム内に固定される。
【００２７】
磁気測定手段２０は、典型的には磁力計及び／又は磁気勾配計である。後者の場合、磁場Ｍの成分の値を測定する代わりに、勾配計は、磁場Ｍの勾配の成分の値、すなわち、空間微分の値を直接測定する（オプションで、磁場に加えて）。このような磁気勾配計２０は、当業者に知られている。本発明のある実施形態によれば、２次微分（次数２の勾配）、一般にｉ次の微分（次数ｉの勾配）の値を直接測定する勾配計を使用することが可能である。
【００２８】
本明細書の残りの部分では、磁力計の例が使用されることになっているが、当業者はそれを勾配計に置き換える方法を知っているであろう。
【００２９】
磁力計又は磁力計（複数）２０は、好ましくは「軸方向」にある、すなわち、前記磁場の成分、すなわち、前記磁場ベクトルＭのそれらの軸に沿った投影（又は、勾配計の場合は、前記磁場の次数ｉの空間微分の成分、すなわち、その軸に沿った勾配計の周囲の∇ｉ−１Ｍ成分の変動）を測定することができる。
【００３０】
磁力計２０は、少なくとも２つの数、好ましくは少なくとも３つの数であり、それぞれ、磁場の少なくとも２つ又は３つの成分を獲得することができる。実際、２つの磁力計は、それらが車両の回転の垂直軸に直交する平面、すなわち水平面内に互いに直交して配置されていれば、十分であり得ることが理解される。しかしながら、３つの磁力計２０を使用し、３つの構成要素を取得することにより、この特定の準備の必要性を克服することが可能になる。
【００３１】
有利には、磁力計２０は、「三軸」の３つのグループ、すなわち、同じ空間位置に関連付けられ、３つの軸に沿って磁場を測定する直交する２×２の磁力計２０のトリプレット（６つの磁力計２０の場合は２つの三軸があり、９つの磁力計２０の場合は３つの三軸がある）によって有利に編成された、６つ又は９つの磁力計のような３つよりも大きい数字でさえある。２つの三軸により、磁場及びその勾配（以下参照）の一部を測定することが可能であり、適切に配置され且つ配向された８つの磁力計２０を用いて、勾配のすべての成分を決定することができる。これは、例えば、矩形の二等辺三角形の角に配置された３つの三軸の場合である。
【００３２】
好ましくは、物体に関連する直交系は、計算を容易にするようなやり方で、三軸が前記直交系に従って有利に配向されるような慣例によって（及び、本明細書の残りの部分については装置によって）選択される。
【００３３】
しかし、当業者は、どのような場合でも、磁力計／勾配計の任意の空間配置に置き換える方法を知っているであろう。
【００３４】
「ジャイロメータ」１１は、物体１のマーカを規定する３つの直交軸系に従って物体１の角速度を測定することができる、すなわち、ωとして記述される角速度ベクトルの３つの成分を測定することができる慣性測定手段を意味する。したがって、ジャイロメータ１１は、実際には、３つの軸のうちの１つ、特に、３軸配置（すなわち、各ジャイロメータは、上述の角速度ベクトルの３つの成分のうちの１つを測定することができる）に関連する３つのジャイロメータのセットを指定することができることが理解される。
【００３５】
物体１が車両である好ましい実施形態では、このマーカは、好ましくは、垂直軸と、２つの水平軸、特に、長手方向軸と、横軸とを含む。車両の垂直軸周りの回転は、運転者がステアリングホイールを回すことによって動作する角度で表される。一般に平坦な地面上では、車両の方向の変化は、水平面内にある、すなわち、ヨーの前記垂直軸にも従う。実際には、ロール（車両の長手方向軸に沿った回転）及びピッチ（車両の横軸に沿った回転）についてのゼロ以外の値は、例えば、傾斜道路の結果であり得るが、典型的には低い。
【００３６】
本発明の方法物体は、角速度ベクトルωの３つの成分を較正することを可能にする。
【００３７】
さらに、物体１は、物体１の測定線速度（Ｖとして記述される）、すなわち、変位、の「付加的な」取得手段１０を有利に備える。これらの手段１０は、直接的又は間接的に、線速度を得ることを可能にすることができ、従って、例えば慣性測定手段などの多くのタイプのものであることができる。従って、ジャイロメータ１１を１つ以上の加速度計で補完することができ、物体１も「６軸」の慣性単位を有することができる。加速度計は、このセンサに加わる重力以外の外力に敏感であり、γとして記述される特定の加速度を測定することができる。
【００３８】
代替的に、物体１が車輪を有する車両である場合、手段１０は、例えば図１の例に示すように、車輪の少なくとも２つの走行距離計、例えば、２つの後輪の少なくとも２つの走行距離計から成ることができる。
【００３９】
「走行距離計」は、回転数をカウントすることにより車輪の速度を測定することができる装置（回転計）を意味する。一般に、走行距離計は、車輪に取り付けられた部分（例えば、磁石）を有し、回転数である単位時間当たりの回転の数をカウントするようにこの固定部分（いわゆる「トップ」）の各通過を検出する。他の技術、例えば、ホイール上のマスクの光学的検出、又はホイールなどの金属物体の回転を検出する特許FR2939514の磁力計が知られている。
【００４０】
ここで、ホイールの「速度」はスカラー、すなわち、地上基準システムにおけるホイールの速度のノルム（滑りがないという仮説の場合）である。ホイールの半径ｒが既知であれば、回転数の測定により、速度：ｖ＝２πｒｆのこのノルムを推定することができる。
【００４１】
また、追加の手段１０は、ＧＮＳＳ受信機であってもよい。当業者は、速度測定のための特定の技術に限定されないことが理解されるであろう。
【００４２】
さらに、物体１は、本方法の処理の特にリアルタイムの実装のための説明された処理手段２１（通常はプロセッサ）、例えば、車両のオンボードコンピュータ、オプションでメモリ２２、及び物体１の動きに関する情報（瞬間速度値、方向、地図上の位置など）を返す、及び／又は、物体１にコマンドを送信するインターフェース２３を有する。物体１は、それ自体、特に自動運転車であることができ、処理手段２１は、車両の自律的なナビゲーションを実施するように構成される。従って、前記コマンドは、運転者による運転をシミュレートするために、車両の制御部材（エンジン、ステアリングホイールのアクチュエータ等）に送られる。
【００４３】
処理手段２１は、物体１の外部にあってもよく、例えば、無線ネットワークによって物体１に接続されてもよいことに留意されたい。代替的には、ジャイロメータ１１及び磁気測定手段２０は、ワイヤで、例えばイーサネット（登録商標）を介してデータ処理手段２１に接続することができる。
【００４４】
方法
【００４５】
本発明の方法の目的は、少なくともジャイロメータ１１を較正する方法である。「較正」とは、１つ又は複数の較正パラメータを決定することを意味し、そのリストを以下に示す。特に、特定の較正パラメータは、信頼性があり、所定のものとみなすことができ、他の較正パラメータは、決定されることになる。決定されることになるものに関して、それらは「現在の」値（他の用語では、較正が既に行われている）を有し、これらの値は、適用可能な場合に修正される（新規の較正の場合）。
【００４６】
特に好ましい実施形態では、この方法はさらに、磁気測定手段２０を較正するための方法であることができる、すなわちジャイロメータ１１と磁力計２０を同時に較正することができる。これは非常に有利なモードである。なぜなら、これから分かるように、ジャイロメトリー（ジャイロメトリーデータ）と磁気データ（磁気データ）のうちの１つが、他方を較正するための基準としてそれを使用するために信頼できると仮定する必要はもはやないからであり、すなわち、２つは互いに自動的に較正する。代替的には、当然ながら、磁力計２０を十分に較正されたとみなし、その結果としてジャイロメータ１１を較正することが可能であり、これは、例えば、ジャイロメータ１１のより多くのパラメータを較正することを可能にする。
【００４７】
以上のように、有利な実施形態では、本方法は、物体１の運動を推定する方法でさえある。すなわち、本方法は、運動の１つ又は複数の成分を確実に推定するために、較正の後に、測定値を使用することを含む。
【００４８】
第１のステップ（ａ）では、この方法は、ジャイロメータ１１による、ω（ｍｅａｓｕｒｅｍｅｎｔ）ｇｙｒｏとして記述される、物体１の測定角速度、及び磁気測定手段２０による、磁場及び／又は磁場のｉ次の微分の少なくとも２つの成分の取得を含む。これらの成分は、より正確には、いわゆる測定成分であり、磁場の場合、Ｍ（ｍｅａｓｕｒｅｍｅｎｔ）として記述される（ｉ次の微分の場合、それは∇ｉＭ（ｍｅａｓｕｒｅｍｅｎｔ）として記述される）ベクトルを形成する。好ましくは、角速度の３つの成分、及び少なくとも６つ又は８つの磁気成分（有利には、矩形の二等辺三角形のコーナーにおける２つ又は３つの磁気三軸位置）が、それらから磁場及びその勾配の少なくとも一部（すなわち、３つの軸に従った以下の次数の導関数）を導出することができるように取得される。
【００４９】
これらの大きさは、物体１の動きの特徴的な時間の前に非常に小さいｄｔ、典型的には４０ｍｓで、サンプリングｄｔを用いて（すなわち、「ｄｔ」秒毎に）有利に測定される。
【００５０】
ステップ（ｂ）では、データ処理手段２１は、物体１の推定角速度並びに磁場及び／又は磁場のｉ次の微分の成分の少なくとも１つの第１の磁気方程式によって定められる第１の式を最小化するジャイロメータ１１の少なくとも１つの較正パラメータの値を決定する。
【００５１】
このアイデアは、磁気方程式によって理論的にリンクされるジャイロメトリックデータと磁気データを別々に推定することである。したがって、この方程式のおかげで、理想的にはゼロであるべき量を表現することができ（すなわち、ジャイロメトリックデータと磁気データは、正確に磁気方程式を満たす）、さもなければ、完全にされなければならないのは較正である。
【００５２】
ω（ｅｓｔｉｍａｔｉｏｎ）ｇｙｒｏとして記述される物体１の推定角速度は、測定角速度及びジャイロメータ１１の較正パラメータに従い、すなわち、一般に、較正パラメータによって決定される関数（アプリケーション）を有する
【数１１】
2021527213.tif 000013
である。最も単純な場合、ｇは微調整され、ω（ｅｓｔｉｍａｔｉｏｎ）ｇｙｒｏは、
【数１】
2021527213.tif 000014
タイプの式によって測定角速度ω（ｍｅａｓｕｒｅｍｅｎｔ）ｇｙｒｏにリンクされ、Ｄ及びｂｇｙｒｏは、ジャイロメータ１１の較正パラメータを表す。
【００５３】
三次元姿勢の場合、ｂｇｙｒｏはバイアスベクトルであり、Ｄは３×３行列=（正しいマーカでの転送のための直交行列）×（スケール係数と較正を含む上三角行列）である。単純化された方法では、例えば、Ｄは所定のものであり（実際には非常にゆっくりと変化する）、ジャイロメータ１１について決定されるべき唯一の較正パラメータはｂｇｙｒｏであり、これは実質的に経時的に変化する傾向がある（ジャイロメータ１１のドリフトと呼ばれる）ことを考慮することが可能である。
【００５４】
説明したように、ステップ（ａ）で取得された磁場及び／又は磁場のｉ次の微分の成分は、好ましくは測定成分（すなわち、バイアスされている可能性がある）であり、前記第１の磁気方程式によって使用される成分は、磁気測定手段２０の測定成分及び較正パラメータによる、推定成分である（磁場の場合、対応するベクトルはＭ（ｅｓｔｉｍａｔｉｏｎ）と記述され、ｉ次の微分の場合、それは∇ｉＭ（ｍｅａｓｕｒｅｍｅｎｔ）と記述されることができる）。
【００５５】
磁気測定手段２０が磁力計である場合（すなわち、作業が、微分ではなく、磁場の成分に関して行われる場合）、磁場の推定成分Ｍ（ｅｓｔｉｍａｔｉｏｎ）は、有利には、
【数２】
2021527213.tif 000015
の形態のモデルによって測定成分Ｍ（ｍｅａｓｕｒｅｍｅｎｔ）にリンクされ、３×３行列Ａ及びベクトルｂｍａｇｎｅｔｏは、磁気測定手段２０の較正パラメータである。それはむしろ、測定成分の関数として表現したい推定成分であり、
【数１２】
2021527213.tif 000016
と書くことが可能である。
【００５６】
ｂｍａｇｎｅｔｏは、概して「硬鉄型」効果を表し、行列Ａは「軟鉄型」効果を表す。これらの効果は、厳密に言えば、硬／軟鉄の効果に対応するが、同一の影響を有するが異なる原因（例えば、磁力計２０のエレクトロニクス／物理学による効果）を有する現象を含むことができる。
【００５７】
ジャイロメータに関しては、より一般的には、一般的な誤差モデル
【数１３】
2021527213.tif 000017
を調べることができ、ｈは必ずしも微調整されていない関数（アプリケーション）である。
【００５８】
微調整されたケース（
【数２】
2021527213.tif 000018
）では、Ａは３×３行列であり、これは、Ｒは直交、
（外１）
2021527213.tif 000019
は上三角である
【数１４】
2021527213.tif 000020
と書くことができる。
【００５９】
なお、磁気測定手段２０自体は、事前に完全に較正されているものと仮定されていることに留意すると、物体１が存在しない場合に測定されるであろう地球磁場を推定することができるように、較正において補正されなければならないのは、それらの直接的な環境（車体等）のみである。従って、行列Ｒは重要であり、物体磁気マーカが安定したままであるように決定される。
【００６０】
球体に関する従来の較正方法は、最も近い軸周りの１回転でのみ決定する（E. Dorveaux, D. Vissiere, A.
P. Martin, N. Petit, "Iterative calibration method for inertial and
magnetic sensors", in Proc. of the 48th IEEE Conf. on Decision and Control
2009参照）。センサ軸は、これらの方法の適用した後に固定されたままではない。
【００６１】
実際には、較正中のＡの８つの係数を決定することができる（１つの係数、テスラ（又はガウス）の物理単位に測定値を結びつけるグローバルスケールファクタを決定することはできないが、同時に、ジャイロメータ１１を較正するためにそれを知る必要はない。
【００６２】
従って、同時二重較正の特に好ましい実施形態では、決定されるべき較正パラメータは３つだけである：ｂｇｙｒｏ、Ａ及びｂｍａｇｎｅｔｏ。この限られた数のパラメータは、物体１が「変化する」軌道（時間の関数として値の大きな多様性を有する方向／速度）を有する場合に、このような二重の較正を可能にする。
【００６３】
磁気方程式
【００６４】
物体１（ボディと呼ばれる）のマーカにおける磁場の経時変化は式
【数１５】
2021527213.tif 000021
によって記述される。
【００６５】
第１項−ω×Ｍは、固定マーカに対するこのマーカの回転に起因する物体１のマーカにおける磁場の変化を記述する。第２項∇Ｍ・Ｖは、不均一磁場を有する領域の運動から生じる測定磁場の変化を記述する。最後に、第３項
（外２）
2021527213.tif 000022
は、磁場の非定常性（例えば、ヨーロッパにおける５０Ｈｚのような周期的な電流、磁石／鋼製の物体の前記物体の近傍での運動など）を考慮に入れる。
【００６６】
「移動可能な」磁気外乱がなければ、すなわち磁場は定常の性質、
【数１６】
2021527213.tif 000023
、を有し、式は
【数６】
2021527213.tif 000024
に減らすことができる。
【００６７】
磁気外乱がまったくない場合、すなわち、磁場は、定常であることに加えて、均一な性質を有する場合、
【数１７】
2021527213.tif 000025
、式は、さらに、
【数５】
2021527213.tif 000026
に減らすことができる。
【００６８】
方位を決定するために磁気センサを用いる場合、この均一性と定常性の二重仮定は、最も頻繁に検証又は仮定される（コンパスを使用する場合のように）。実際、地球磁場について、金属構造物や強化コンクリート製のもの（典型的には橋）が周囲に存在する場合を除いて、均一性は、我々の緯度において極めて良好な近似として局所的に観測される。近傍の変位物体による非定常性は、外乱のソースが移動しなければならないので、さらに稀であり、周期的な電流による非定常性は、平均ゼロであり、推定技術を用いて処理することもでき、例えば、文献C.-I.  Chesneau,  M.  Hillion,  and  C.  Prieur,  Motion  estimation  of  a  Rigid  Body  with  an  EKF  using  Magneto-Inertial  Measurements,  7th  Conf.  on  Indoor  Positioning  and  Indoor  Navigation  (IPIN'16),  Madrid,  Spain,  2016を参照されたい。
【００６９】
磁気計測定を用いて評価された磁場の空間的及び時間的変動ではなく、特に勾配計測定を用いて評価された磁気勾配の空間的及び時間的変動（すなわち、磁場の空間的変動）をリンクするような方法で、磁気方程式を一般化する可能性が知られていることに留意されたい。より正確には、式
【数６】
2021527213.tif 000027
は、ｎ＋ｉ≧ｉ≧１で、
【数１８】
2021527213.tif 000028
として導出され、∇ｎＭは磁場のｎ次微分、ｆｎ及びｇｎは所定の関数であり、出願FR1756675を参照されたい。
【００７０】
本明細書の残りの部分では、商品によって、０次方程式が使用される（すなわち、
【数６】
2021527213.tif 000029
に基づく）が、当業者は、この方法をより高い次数に変換する方法を知っているであろう。
【００７１】
図２を参照すると、本較正方法は、いくつかのレベルの仮定を有する較正を巧みに提案する。
【００７２】
より正確には、ステップ（ｂ）において、まず、磁場の均一性と定常性の二重の仮定を行うことによってジャイロメータを較正し、次に、較正パラメータ上の誤差を表すパラメータを推定するオプションのステップ（ｃ）において、外乱がないこと、すなわち、仮定の妥当性が検証される。
【００７３】
好ましい実施形態では、この検証が失敗した場合（誤差を表す前記パラメータが所定の閾値よりも大きい場合）、較正は、ステップ（ｄ）において、定常性の仮定のみ（かつもはや均一性の仮定ではない）を行うことによって、再度試みられる。ステップ（ｅ）では、この仮定の妥当性を再検証することができる。代替的には、ステップ（ｃ）の検証が失敗した場合（誤差を表す前記パラメータが所定の閾値よりも大きい場合）、この方法を停止し、現在の較正を維持することができる。
【００７４】
しかしながら、ステップ（ｄ）の存在は、前述した追加の収集手段１０を有する条件で、磁場が均一でない可能性のある場合に較正を実行することを可能にすることが理解される。しかし、本発明は、この実施形態に限定されるものではなく、ジャイロメータ１１及び磁気測定手段２０のみを有することが可能であり、ステップ（ａ）、（ｂ）及びオプションで（ｃ）のみを実施することが可能である。
【００７５】
したがって、可能なステップ（ｄ）は、Ｖとして記述される物体１の測定線速度の追加の取得手段１０による取得と（実際には、この取得は、特に、各時間ステップにおいて、ステップ（ａ）の他の取得と同時に実施することができる）、次に、データ処理手段２１によって、物体１の推定角速度と線速度並びに磁場及び／又は磁場のｉ次の微分の成分についての少なくとも１つの第２の磁気方程式とによって規定される第２の式を最小化するジャイロメータ１１の少なくとも１つの較正パラメータの値を再決定することとを含み、少なくとも１つの第２の磁気方程式は、磁場が磁気測定手段２０の周囲で定常であることだけを仮定する。
【００７６】
「取得」は、広い意味、すなわち、直接的又は間接的に理解されるべきである。実際には、手段１０は、ほとんどの場合線速度ではない第１の大きさ（加速度、車輪の回転数など）を測定し、いわゆる測定線速度は、実際これらの大きさから推定され、オプションで組み合わされる。当業者は、物体１の線速度を、例えば磁気グラジオメトリー（磁気勾配計測）によって、多くの方法で得る方法を知っているであろう。
【００７７】
したがって、磁場がステップ（ｄ）で使用される磁気測定手段２０の周りで定常であることだけを仮定した少なくとも１つの第２の方程式は、好ましくは、
【数４】
2021527213.tif 000030
の形態であり、ωは理論的角速度であり、磁場の成分が直接測定される好ましい実施形態で説明されるような
【数１９】
2021527213.tif 000031
である。
【００７８】
従って、磁気測定手段２０の周囲の磁場の定常性の仮定において、量
【数２０】
2021527213.tif 000032
（特に、次数０におけるそのバージョン
【数２１】
2021527213.tif 000033
）は、最も近い較正誤差においてゼロに等しいことが理解される。
【００７９】
同様に、ステップ（ｂ）で使用される磁場が磁気測定手段２０の周囲で均一かつ定常であると仮定する少なくとも１つの第１の磁気方程式は、少なくとも１つの第２の方程式の単純化されたバージョンであり、好ましくは、
【数３】
2021527213.tif 000034
の形態であり、磁場の成分が直接測定される好ましい実施形態において説明されるような
【数５】
2021527213.tif 000035
である。従って、磁気測定手段２０の周囲の磁場の均一性及び定常性の二重の仮定において、量
【数２２】
2021527213.tif 000036
（特に次数０におけるそのバージョン
【数２３】
2021527213.tif 000037
）は、最も近い較正誤差においてゼロに等しいことが理解される。
【００８０】
第１の較正は、線速度Ｖの知識を必要としないので、実行が容易であることが分かる。
【００８１】
有利には、第１の式（ステップ（ｂ）で最小化される）は、
【数２３】
2021527213.tif 000038
、好ましくは、
【数２４】
2021527213.tif 000039
又は
【数２５】
2021527213.tif 000040
の関数であり、第２の式（ステップ（ｄ）で最小化される）は、
【数２６】
2021527213.tif 000041
、好ましくは、
【数２７】
2021527213.tif 000042
又は
【数２８】
2021527213.tif 000043
の関数である。一般的な条件下では、これらの式の最小化は一般的な軌跡に対してあいまいさなしにパラメータを与える。しかしながら、代替的には、当業者であれば、第１／第２の式（ノルム（norme）のＬ２、Ｌ∞など）によって定められる関係に関連して差異に感受性のある任意の他の関数を第１／第２の式として使用することができることが理解される。
【００８２】
この最小化を実装するために、データ処理手段２１は、所与の長さのインターバルで経時的に動作することができる。そのようなものとして、既知の方法では、再帰フィルタ（ＲＬＳ、再帰最小二乗法など）又は最適化（最小二乗法など）を使用することができる。
【００８３】
例えば、磁力計２０の較正パラメータ、すなわち、パラメータＡ及びｂｍａｇｎｅｔｏが同時に決定される仮定において、
【数２９】
2021527213.tif 000044
又は
【数３０】
2021527213.tif 000045
が、
【数３１】
2021527213.tif 000046
及び
【数１２】
2021527213.tif 000047
を用いて最小二乗法で最小化される、いわゆる差分較正原理を実施することが可能である。
【００８４】
誤差特性評価
【００８５】
説明したように、本方法は有利には、較正パラメータ上の誤差を表すパラメータを推定するステップ（ｃ）を含み、さらに有利には、（ステップ（ｃ）及び（ｄ）が行われた場合には）較正パラメータ上の誤差を表す前記パラメータを新たに推定するステップ（ｅ）を含む。
【００８６】
このアイデアは、周囲磁場に関する仮定のレベルを検証するために、又は検証しないために、磁気測定手段２０によって提供される情報の質を推定することである。より正確には、図２に示すように：
−  誤差を表すパラメータの第１の推定（ステップ（ｃ））が、前記所定の閾値よりも小さい場合、周囲磁場の均一性及び定常性の二重の仮定が検証され、ステップ（ｂ）の較正の結果が受け入れられる。次いで、ステップ（ｃ）は、較正パラメータのステップ（ｂ）で決定された値によるジャイロメータ１１及び／又は磁気測定手段２０の有効な較正を含み、ステップ（ｄ）及び（ｅ）を実行する必要はない；
−  誤差を表すパラメータの第１の推定（ステップ（ｃ））が前記所定の閾値よりも大きい場合、周囲磁場の均一性及び定常性の二重の仮定は棄却され、ステップ（ｂ）の較正の結果は受け入れられず、停止する又はステップ（ｄ）であって：
〇  誤差を表すパラメータの第２の推定（ステップ（ｅ））が、前記所定の閾値未満の時間である場合、周囲磁場の定常性のみの仮定が検証され、ステップ（ｂ）の較正の結果が受け入れられる。次いで、ステップ（ｅ）は、較正パラメータのステップ（ｄ）で決定された値によるジャイロメータ１１及び／又は磁気測定手段２０の有効な較正を含む；
〇  誤差を表すパラメータの第２の推定（ステップ（ｅ））が常に前記所定の閾値よりも大きい場合、周囲磁場の定常性の仮定さえも棄却され（摂動が存在する）、ステップ（ｄ）の較正の結果は受け入れられない。従って、前者の較正のパラメータは、較正として維持される。その後、完全な磁気方程式（項
（外２）
2021527213.tif 000048
を含む）を使用するか、又は磁気測定値を一時的に破棄するかのいずれかを試みることが可能である；
ステップ（ｄ）の再較正を実行することができる：
【００８７】
なお、ステップ（ｂ）及び／又は（ｄ）の発生中の決定された値は、有効な較正には使用されないが、データ記憶手段１２に記憶することができ、ステップ（ｃ）及び／又は（ｅ）の将来の発生中に使用することができる。例えば、誤差を表すパラメータが閾値を超える限り、決定された較正パラメータが記憶され、閾値を下回る場合、有効な較正は、記憶された値も考慮に入れる。さらに、ステップ（ｃ）及びステップ（ｅ）の結果は、（例えば、閾値の値を介して）以前の較正パラメータの年齢に依存し得る。
【００８８】
最後の良好な較正以降の継続時間ｔの後の累積誤差間隔は、この継続時間ｔに従って推定されることができ、例えば、継続時間ｔに比例する増分をこの誤差に加算することによる、この較正における推定誤差であり得ることに留意されたい。予測された誤差間隔は、将来の較正の結果を特徴付けるために使用することができ、特に、前記所定の閾値の値を定義するために使用することができる：例えば、誤差間隔が大きいほど、ジャイロメータを再較正することがより緊急になり、従って、誤差を表すパラメータの値に対して「寛容性」が高くなる（すなわち、所定の閾値はより高い）。さらに、誤差間隔は、推定誤差が大きいときに比例的により速く増加し、これは、非常に低い推定誤差を有する「良好」な計算を長時間保持することが可能となり、一方、「あまり良好でない」較正の再較正をより速く強いる。
【００８９】
概して、較正パラメータ上の誤差を表す前記パラメータは、較正パラメータの決定された値に対して計算された、第１／第２の式の値の関数である（それがパラメータの第１の推定の発生であるか第２の推定の発生であるかに従う）。
【００９０】
ステップ（ｃ）／（ｅ）の第１の実施形態は、ステップ（ｂ）／（ｄ）で利用可能な大きさのみを使用するので、内的であると言われる。好ましくは、ステップ（ｂ）／（ｄ）からの推定残余（residus）が使用される、すなわち、誤差を表す前記パラメータは、特に、所与の時間間隔にわたる第１／第２の式の値のノルム（例えば、Ｌ２又はＬ∞）、典型的には、
【数２９】
2021527213.tif 000049
又は
【数３０】
2021527213.tif 000050
である。このような場合、ステップ（ｄ）／（ｅ）は、ステップ（ｂ）／（ｄ）と同時に実行することができる。再帰フィルタの場合、一定期間にわたるフィルタのイノベーション（innovation）のノルム（例えば、Ｌ２又はＬ∞）を使用することができる。
【００９１】
代替的には、偏差は、正規分布に関連して定量化することができ、すなわち、
【数３２】
2021527213.tif 000051
（又は
【数３３】
2021527213.tif 000052
）の統計値がガウスノイズの統計値に類似しているか否かを、例えば、２より高い次数のモーメントを計算することによって、検査することができる。
【００９２】
外的と呼ばれるステップ（ｃ）／（ｅ）の第２の実施形態では、別のタイプの大きさが、推定角速度と比較するために、これらの大きさのいずれかに基づいて、いわゆる基準角速度を計算するような方法で、使用される。
当業者は、そのような基準角速度を様々な種類の大きさから計算する方法を知っており、特に、例えば：
−  ハンドル角（物体１が車両の場合）、
−  ＧＮＳＳデータ、例えばＧＰＳ（利用可能な場合／利用可能なとき）、
−  走行距離計のデータ、
を使用することが可能である
【００９３】
後者の場合、線速度の追加の取得手段１０が少なくとも２つの走行距離計からなる場合（なお、物体１が車両の場合）、前記理論的角速度は、車輪の測定速度から実際に得ることができる。特に、後輪が各々走行距離計を備えている場合、アッカーマン差動ジオメトリを仮定すると、物体１の第２の推定角速度は、
【数３４】
2021527213.tif 000053
のタイプの式によって左後輪及び右後輪のそれぞれについての測定速度ｖＬ、ｖＲにリンクされ、ｄは車輪間の距離であり、誤差を表す前記パラメータは、その結果、特に、所与の時間間隔にわたる
【数３５】
2021527213.tif 000054
のノルム（例えば、Ｌ２又はＬ∞）であり、
（外３）
2021527213.tif 000055
は、物体１の垂直軸の周りの回転のみに対する角速度である。
【００９４】
第３の実施形態によれば、誤差パラメータの推定の第１の発生（ステップ（ｃ））に関して、磁場及び／又は磁場のｉ次の微分の前記成分の空間勾配全て又は一部、すなわち、∇Ｍ又は∇ｉ+１Ｍを、使用する第２の方程式の次数に従って、極めて簡単に推定することが可能である。
【００９５】
実際、この推定は、均一な性質を維持するためにはゼロに近くなければならない。勾配の成分のサブセットの推定は、各非零成分が既に不均一性の発現であるので、実際にはこの特性評価に十分であることが理解される。
【００９６】
代替的に又は補足として、この誤差パラメータの推定を改善するため、及び／又は、よりロバストな方法で、かつ、利用可能性を増加させて、好ましい条件（すなわち、定常及び均一）を識別するためのアプローチを開発するために、学習を用いることができる。
【００９７】
特に、ニューラルネットワーク、サポートベクトルを用いるマシン、最近傍法、決定木などの学習メカニズムを実装することが可能である。従って、ステップ（ｂ）から（ｅ）の各発生時に、各測定データセットが、（ステップ（ｂ）から（ｅ）の連続した発生が起こるように）漸進的に、且つ許容可能な較正を許容不可能な較正から区別するように自動的に学習するような方法で、誤差を表すパラメータの対応する値で「タグ付けされる」学習ベースを充実させることができる。このように、較正は常に改善されている。
【００９８】
運動の推定
【００９９】
説明したように、本方法は、有利には、物体１の測定角速度及び／又は、磁場及び／又は磁場のｉ次の微分の少なくとも２つの成分、及び／又は（手段１０による）物体１の任意の測定された線速度、及び、較正パラメータの値、すなわち、再較正後の値に応じて、物体１の運動をデータ処理手段２１によって推定するステップ（ｆ）を含む。このステップ（ｆ）は、較正に焦点を当てた図２には示されていないが、並列に連続的に実行することができる。
【０１００】
「運動の推定」とは、特に、少なくとも物体１の向き（水平面、すなわち、方位）の推定を意味し、有利には、法線速度の推定を意味する。向きは、典型的には、既知の初期配向からの角速度の積分によって得られる。
【０１０１】
好ましくは、前記物体１の方位のデータ処理手段２１による推定は、物体１の測定角速度及び較正パラメータの値に応じてのみ、すなわちジャイロメトリックデータのみを用いて行われる。要約すると、磁気データは、ジャイロメータ１１を較正するために使用され、次いで、方位を推定するためにジャイロメータデータだけが使用される。該当する場合、測定された線速度（オプションの手段１０による）は、ステップ（ｆ）において、物体１のグローバル速度を決定するためにのみ使用される。
【０１０２】
自動運転車両の場合、ステップ（ｆ）は、例えば車両１を所望の目的地に運ぶ、又は車両１を障害物のない軌道に保持することによって車両１を停止させるような方法で、推定された運動に応じた前記車両１のコマンドの生成を含むことができることに留意されたい。
【０１０３】
機器及び物体
【０１０４】
第２の態様によれば、本発明は、特に、本方法の実施形態の一又は他を実施するための装置１１、２０、２１及びオプションで１０のセットに関する。
【０１０５】
このセットは、「従来の」物体１に、それを変換するような方法でキットとしてインストールすることができる。代替的に、特に、物体１が車両である場合、これは、車両のナビゲーションのためのデータ処理手段２１、並びに追加の取得手段１０として使用されるジャイロメータ１１及び／又は走行距離計などのセンサを既に備えている自動運転車両であることができる。
【０１０６】
物体１は、特に、車輪型の車両について特に提案されており、以下を含む：
−  物体１の測定角速度を取得するように構成されるジャイロメータ１１；
−  磁場及び／又は磁場のｉ次の微分の少なくとも２つの成分を取得するように構成される磁気測定手段２０；
−  該当する場合、物体１の測定線速度を取得するように構成される追加の取得手段１０（有利には、車両の車輪の少なくとも２つに取り付けられ、前記２つの車輪の測定速度を取得するように構成される走行距離計）；
−  データ処理手段２１であって、
〇  物体１の推定角速度並びに磁場及び／又は磁場のｉ次の微分の成分の少なくとも１つの第１の磁気方程式によって定義される第１の式を最小化するジャイロメータ１１の少なくとも１つの較正パラメータの値を決定するように構成され、
・  物体１の推定角速度は、測定角速度及びジャイロメータ１１の較正パラメータの関数であり、
・  少なくとも１つの第１の磁気方程式は、磁場が磁気測定手段２０の周囲で均一かつ定常であると仮定し、
−  データ処理手段２１は、さらに以下のように構成することができ：
〇  較正パラメータ上の誤差を表すパラメータを推定し：
〇  誤差を表す前記パラメータが所定の閾値より大きい場合、物体１の推定角速度並びに、測定線速度、磁場及び／又は磁場のｉ次の微分の成分の少なくとも１つの第２の磁気方程式によって定義される第２の式を最小化するジャイロメータ１１の少なくとも１つの較正パラメータの値を再決定し、少なくとも１つの第２の磁気方程式は、磁場が磁気測定手段２０の周りで定常であることのみを仮定する。
【０１０７】
上述したように、物体１は、さらに、メモリ２２及びインターフェース２３、ならびにハンドル角センサ又はＧＮＳＳ受信機などの他のセンサを含むことができる。
【０１０８】
さらに、データ処理手段２１は、物体１の測定角速度にしたがって、物体１の測定角速度と、及び／又は物体１の測定線速度（該当する場合は、誤差を表す前記パラメータと閾値との比較結果）と、較正パラメータの値とにしたがって、前記物体１の動きを推定するように構成することができる。
【０１０９】
コンピュータプログラム製品
【０１１０】
第３の態様及び第４の態様によれば、本発明は、本発明の第１の態様によるジャイロメータ１１を較正する方法の実行（処理手段２１上）のためのコード命令を備えるコンピュータプログラム製品と、そこでこのコンピュータプログラム製品が見つかるコンピュータ装置の一部（例えば、データ記憶手段２２）によって読み取ることができる記憶手段とに関する。
【図１】
2021527213.tif 000066
【図２】
2021527213.tif 000067
【国際調査報告】
2021527213.tif 000068
2021527213.tif 000069
2021527213.tif 000070
2021527213.tif 000071
2021527213.tif 000072