JP2019509073A5 - - Google Patents

Download PDF

Info

Publication number
JP2019509073A5
JP2019509073A5 JP2018530694A JP2018530694A JP2019509073A5 JP 2019509073 A5 JP2019509073 A5 JP 2019509073A5 JP 2018530694 A JP2018530694 A JP 2018530694A JP 2018530694 A JP2018530694 A JP 2018530694A JP 2019509073 A5 JP2019509073 A5 JP 2019509073A5
Authority
JP
Japan
Prior art keywords
magnetometers
calibrating
measurement unit
inertial measurement
data collected
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
JP2018530694A
Other languages
English (en)
Other versions
JP2019509073A (ja
JP6971234B2 (ja
Filing date
Publication date
Application filed filed Critical
Priority claimed from PCT/US2016/067387 external-priority patent/WO2017106794A1/en
Publication of JP2019509073A publication Critical patent/JP2019509073A/ja
Publication of JP2019509073A5 publication Critical patent/JP2019509073A5/ja
Application granted granted Critical
Publication of JP6971234B2 publication Critical patent/JP6971234B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Description

以下、適当な歪み閾値パラメータの計算について、詳細に説明する。一般的に、この計算に使用可能なアルゴリズムでは、(1)IMU運動(または、運動がないこと)は、すべてのIMU(加速度計、ジャイロスコープ、および磁力計)により検出可能である、(2)校正された磁力計の角度および長さは、略同一の値を有するものとする、(3)校正された磁力計のベクトルは、大きさが略一致するものとする、(4)校正された磁力計のベクトルと校正された加速度計のベクトルとの間の角度は、変化しないものとする、(5)校正された磁力計の半径は、1に略等しいものとする、(6)異なる磁力計を用いて計算された四元数は、略等しいものとする、という前提を利用する可能性がある。
異常検出は、3つの検出カテゴリに基づく。第1はセンサ障害検出、第2は磁力計半径確認、第3は四元数出力の差異である。センサ障害検出は、(i)運動および磁気異常、(ii)磁気強度、ならびに(iii)磁力計と加速度計のベクトル間の角度といった関数から成る。以下の方法を用いて、校正により、運動異常およびコスト関数の閾値(TV)を一貫して抽出する。この方法では、以下のようなアルゴリズム(1)を利用する。
四元数出力の差異は、異なる磁力計の使用により計算された配向出力に基づく検出方法である。四元数出力の差異の閾値の決定には、以下のアルゴリズム(8)が用いられるようになっていてもよく、アルゴリズム(6)の四元数出力を使用して、四元数間の角度を計算する。
本開示によれば、アルゴリズム(6)によってIMUの配向を計算することができ、アルゴリズム(8)によって角度差を計算することができる。以下の表(7)を用いて、四元数出力の差異が存在するかを識別することができる。

Claims (22)

  1. 慣性測定ユニットを校正する方法であって、
    第1のステップとして、静止中の前記慣性測定ユニットからデータを収集するステップと、
    第2のステップとして、前記慣性測定ユニットの3つの直交軸周りで前記慣性測定ユニットを再位置決め中に前記慣性測定ユニットからデータを収集するステップと、
    前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて複数のジャイロスコープを校正するステップと、
    前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて複数の磁力計を校正するステップと、
    前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて複数の加速度計を校正するステップと、
    含み、
    前記複数の磁力計を校正するステップが、歪み検出用パラメータを抽出することと、前記抽出したパラメータを用いて、前記慣性測定ユニットの局所場内に磁気歪みが存在するかを判定することと、を含む、方法。
  2. 前記歪み検出用パラメータ抽出では、(1)前記慣性測定ユニットの運動は、前記慣性測定ユニットを構成する前記複数の加速度計、前記複数のジャイロスコープ、および前記複数の磁力計のすべてにより検出可能である、(2)前記複数の磁力計のそれぞれの角度および長さは、略同一の値を有する、(3)複数の磁力計のベクトルはそれぞれ、大きさが略一致する、(4)校正された磁力計のベクトルと校正された加速度計のベクトルとの間の角度は、変化しないものとする、(5)校正後の前記複数の磁力計の半径は、1に略等しい、ならびに(6)前記複数の磁力計のうちの異なる磁力計を用いて計算された四元数は、略等しい、という前提のうちの少なくとも1つを採用する、請求項1に記載の方法。
  3. 前記慣性測定ユニットの運動は、前記慣性測定ユニットを構成する前記複数の加速度計、前記複数のジャイロスコープ、および前記複数の磁力計のすべてにより検出可能である、という前記前提からの逸脱が、運動異常の決定となる、請求項2に記載の方法。
  4. (2)前記複数の磁力計のそれぞれの角度および長さは、略同一の値を有する、(3)複数の磁力計のベクトルはそれぞれ、大きさが略一致する、(4)校正された磁力計のベクトルと校正された加速度計のベクトルとの間の角度は、変化しないものとする、(5)校正後の前記複数の磁力計の半径は、1に略等しい、ならびに(6)前記複数の磁力計のうちの異なる磁力計を用いて計算された四元数は、略等しい、という前記前提のうちのいずれか1つからの逸脱が、磁気異常の決定となる、請求項3に記載の方法。
  5. 前記複数のジャイロスコープを校正するステップが、算術平均によって各ジャイロスコープのバイアスを決定することを含む、請求項1に記載の方法。
  6. 前記複数の磁力計を校正するステップが、任意の軟化鉄歪みが存在するか、および、任意の硬化鉄歪みが存在するか、の少なくとも一方を判定することを含む、請求項1に記載の方法。
  7. 任意の軟化鉄歪みが存在するか、および、任意の硬化鉄歪みが存在するか、の少なくとも一方を判定することが、前記複数の磁力計から収集された前記データに対して多次元楕円フィッティング関数を利用することを含む、請求項6に記載の方法。
  8. 前記複数の磁力計を校正するステップが、基準整列からの前記磁力計間の整列差を考慮することを含む、請求項1に記載の方法。
  9. 前記複数の磁力計を校正するステップが、新しい基準整列に対して前記複数の磁力計を校正することを含む、請求項1に記載の方法。
  10. 前記複数の加速度計を校正するステップが、前記第2のステップにおいて前記複数の加速度計から収集された前記データに対して多次元楕円フィッティング関数を適用することを含む、請求項1に記載の方法。
  11. 前記複数のジャイロスコープを校正するステップが、歪み検出用パラメータを抽出することと、前記抽出したパラメータを用いて、運動異常が存在するかを判定することと、を含む、請求項1に記載の方法。
  12. 前記複数の加速度計を校正するステップが、運動状態を表す値に関して、前記第2のステップにおいて前記複数の加速度計から収集された前記データが前記第1のステップにおいて前記複数の加速度計から収集された前記データよりも大きなを有することを確認することを含む、請求項1に記載の方法。
  13. 前記複数のジャイロスコープを校正するステップが、運動状態を表す値に関して、前記第2のステップにおいて前記複数のジャイロスコープから収集された前記データが前記第1のステップにおいて前記複数のジャイロスコープから収集された前記データよりも大きなを有することを確認することを含む、請求項1に記載の方法。
  14. 前記複数の磁力計を校正するステップが、運動状態を表す値に関して、前記第2のステップにおいて前記複数の磁力計から収集された前記データが前記第1のステップにおいて前記複数の磁力計から収集された前記データよりも大きなを有することを確認することを含む、請求項1に記載の方法。
  15. 前記複数の磁力計を校正するステップが、前記第2のステップにおいて前記複数の磁力計から収集された前記データに対して多次元楕円フィッティング関数を適用することを含む、請求項1に記載の方法。
  16. 前記複数の磁力計を校正するステップが、前記第2のステップにおいて前記複数の磁力計から収集された前記データから、配向出力の四元数を計算することを含む、請求項1に記載の方法。
  17. 前記複数の磁力計を校正するステップが、前記計算した配向出力の四元数間の角度を計算することを含む、請求項16に記載の方法。
  18. 前記複数の磁力計を校正するステップが、前記第2のステップにおいて前記複数の磁力計から収集された前記データに対して磁力計半径計算を適用することにより、磁気異常が存在するかを判定することを含む、請求項1に記載の方法。
  19. 前記磁気異常が存在する場合は、前記磁気異常の強度を計算する、請求項18に記載の方法。
  20. 複数のジャイロスコープ、複数の磁力計および複数の加速度計を有した慣性測定ユニットであって、
    前記慣性測定ユニットは、静止中の前記慣性測定ユニットからデータを収集する第1のステップと、前記慣性測定ユニットの3つの直交軸周りで前記慣性測定ユニットを再位置決め中に前記慣性測定ユニットからデータを収集する第2のステップと、が実行され、
    前記複数のジャイロスコープは、前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて校正されたものであり、
    前記複数の磁力計は、前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて校正されたものであり、
    前記複数の加速度計は、前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて校正されたものであり、
    前記複数の磁力計の校正においては、歪み検出用パラメータを抽出し、前記抽出したパラメータを用いて前記慣性測定ユニットの局所場内に磁気歪みが存在するか判定される慣性測定ユニット。
  21. 術ナビゲーションシステムの一部として組み込まれた請求項20に記載の慣性測定ユニット。
  22. 手術ナビゲーションで用いられるように構成された請求項20に記載の慣性測定ユニット。
JP2018530694A 2015-12-16 2016-12-16 Imu校正 Active JP6971234B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
US201562268175P 2015-12-16 2015-12-16
US62/268,175 2015-12-16
PCT/US2016/067387 WO2017106794A1 (en) 2015-12-16 2016-12-16 Imu calibration

Publications (3)

Publication Number Publication Date
JP2019509073A JP2019509073A (ja) 2019-04-04
JP2019509073A5 true JP2019509073A5 (ja) 2020-09-03
JP6971234B2 JP6971234B2 (ja) 2021-11-24

Family

ID=59057715

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018530694A Active JP6971234B2 (ja) 2015-12-16 2016-12-16 Imu校正

Country Status (9)

Country Link
US (3) US10852383B2 (ja)
EP (2) EP3795109B1 (ja)
JP (1) JP6971234B2 (ja)
KR (1) KR102321695B1 (ja)
CN (1) CN109069067B (ja)
AU (3) AU2016369607B2 (ja)
CA (2) CA3008479C (ja)
ES (2) ES2869524T3 (ja)
WO (1) WO2017106794A1 (ja)

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110794960B (zh) 2014-12-08 2024-02-06 罗希特·塞思 可穿戴无线hmi装置
US9532845B1 (en) 2015-08-11 2017-01-03 ITKR Software LLC Methods for facilitating individualized kinematically aligned total knee replacements and devices thereof
CA3008479C (en) 2015-12-16 2022-10-18 Mohamed R. Mahfouz Imu calibration
WO2019241516A1 (en) * 2018-06-13 2019-12-19 New York Society For The Ruptured And Crippled Maintaining The Hospital For Special Surgery Evaluation of instability using imaging and modeling following arthroplasty
FR3082612B1 (fr) * 2018-06-13 2021-01-01 Sysnav Procede de calibration d'un gyrometre equipant un objet
US10852143B2 (en) * 2018-06-27 2020-12-01 Rohit Seth Motion sensor with drift correction
US10539644B1 (en) 2019-02-27 2020-01-21 Northern Digital Inc. Tracking an object in an electromagnetic field
CN110530396A (zh) * 2019-07-31 2019-12-03 苏州浪潮智能科技有限公司 一种陀螺仪传感器误差的处理方法及设备
CN110567491B (zh) * 2019-08-29 2021-10-08 青岛歌尔智能传感器有限公司 惯性导航系统的初始对准方法、装置及电子设备
EP4052273A1 (en) * 2019-10-31 2022-09-07 Babysteps Orthopedics Inc. Predictive modeling platform for serial casting to correct orthopedic deformities
CN111506966B (zh) * 2020-04-20 2024-03-22 成都飞机工业(集团)有限责任公司 工艺协调模型的判别方法、装置、电子设备和存储介质
TWI753412B (zh) * 2020-04-27 2022-01-21 長庚醫療財團法人林口長庚紀念醫院 產生用於自動定位出定位點的模型的方法、骨骼狀態分析方法及電子系統
US11621086B2 (en) 2020-06-04 2023-04-04 Episurf Ip-Management Ab Customization of individualized implant
HUP2000276A1 (hu) * 2020-08-19 2022-02-28 Grayscalelab Kft Orvosi eszköz orientációjának követésére szolgáló rendszer
CN112013876A (zh) * 2020-08-28 2020-12-01 上海爱观视觉科技有限公司 Imu数据标定方法、终端设备及计算机可读存储介质
CN111879971A (zh) * 2020-09-28 2020-11-03 蘑菇车联信息科技有限公司 一种imu中加速度计的标定方法及相关装置
CN112629565B (zh) * 2021-03-08 2021-06-01 中国人民解放军国防科技大学 像机与惯性测量单元旋转关系校准方法、装置和设备
CN113406646B (zh) * 2021-06-18 2023-03-31 北京师范大学 基于多方向超声测距及imu进行三维定位的方法和设备
CN115208760B (zh) * 2022-07-14 2024-02-27 上海移为通信技术股份有限公司 运动检测芯片的配置方法、装置及介质
US12034909B2 (en) * 2022-09-16 2024-07-09 Movella Holdings B.V. Any pose motion capture calibration methods and apparatus
WO2024196995A1 (en) * 2023-03-21 2024-09-26 CAIRA Surgical Systems and methods for medical object tracking in obstructed environments
CN116862985B (zh) * 2023-09-01 2023-11-10 江苏中安建设集团有限公司 一种土地高精度定位电子信息化监测方法
CN117589203B (zh) * 2024-01-18 2024-05-10 陕西太合智能钻探有限公司 一种陀螺仪标定方法

Family Cites Families (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0996534A (ja) * 1995-09-29 1997-04-08 Matsushita Electric Ind Co Ltd ナビゲーション装置
US7432868B2 (en) 2004-04-26 2008-10-07 Spencer Webb Portable antenna positioner apparatus and method
US7219033B2 (en) * 2005-02-15 2007-05-15 Magneto Inertial Sensing Technology, Inc. Single/multiple axes six degrees of freedom (6 DOF) inertial motion capture system with initial orientation determination capability
IL167648A (en) * 2005-03-24 2011-01-31 Elbit Systems Ltd Hybrid tracker
US20070032748A1 (en) * 2005-07-28 2007-02-08 608442 Bc Ltd. System for detecting and analyzing body motion
JP2007040762A (ja) * 2005-08-01 2007-02-15 Toyota Motor Corp 光ジャイロ較正装置、光ジャイロを搭載するロボット及び光ジャイロ較正プログラム
US8000772B2 (en) * 2005-10-19 2011-08-16 Biosense Webster, Inc. Metal immunity in a reverse magnetic system
EP1952303B8 (en) 2005-11-11 2016-08-17 Hologic, Inc. Estimating risk of future bone fracture utilizing three-dimensional bone density model
US20120209117A1 (en) * 2006-03-08 2012-08-16 Orthosensor, Inc. Surgical Measurement Apparatus and System
FR2934043B1 (fr) * 2008-07-18 2011-04-29 Movea Sa Procede d'estimation ameliore de l'orientation d'un objet et centrale d'attitude mettant en oeuvre un tel procede
US7912664B2 (en) * 2008-09-11 2011-03-22 Northrop Grumman Guidance And Electronics Company, Inc. Self calibrating gyroscope system
US20110063167A1 (en) 2009-09-15 2011-03-17 Qualcomm Incorporated Using magnetometer with a positioning system
US8766872B2 (en) 2008-12-24 2014-07-01 Enzo Dalmazzo Autonomous wireless antenna sensor system
US8444564B2 (en) * 2009-02-02 2013-05-21 Jointvue, Llc Noninvasive diagnostic system
US8108171B2 (en) * 2009-09-14 2012-01-31 Honeywell International, Inc. Systems and methods for calibration of gyroscopes and a magnetic compass
US8645093B2 (en) * 2009-11-04 2014-02-04 Qualcomm Incorporated Calibrating multi-dimensional sensor for offset, sensitivity, and non-orthogonality
JP5540850B2 (ja) * 2010-04-09 2014-07-02 トヨタ自動車株式会社 姿勢推定装置、方法及びプログラム
US8825426B2 (en) * 2010-04-09 2014-09-02 CSR Technology Holdings Inc. Method and apparatus for calibrating a magnetic sensor
WO2011162753A1 (en) * 2010-06-23 2011-12-29 Mako Sugical Corp. Inertially tracked objects
CN103153790B (zh) * 2010-10-01 2016-06-08 希尔克瑞斯特实验室公司 使用运动传感器和附接至装置的磁力计的测量数据估计该装置在重力参照系中的偏航角的设备和方法
US8577640B2 (en) * 2011-08-17 2013-11-05 Invensense, Inc. Magnetometer bias and anomaly detector
US9141194B1 (en) * 2012-01-04 2015-09-22 Google Inc. Magnetometer-based gesture sensing with a wearable device
US10132829B2 (en) * 2013-03-13 2018-11-20 Invensense, Inc. Heading confidence interval estimation
US9854991B2 (en) * 2013-03-15 2018-01-02 Medtronic Navigation, Inc. Integrated navigation array
US20150019159A1 (en) * 2013-07-15 2015-01-15 Honeywell International Inc. System and method for magnetometer calibration and compensation
EP2883272B1 (en) * 2013-08-27 2016-06-15 CommScope Technologies LLC Alignment determination for antennas and such
EP3080619B1 (en) 2013-12-09 2019-02-13 Mohamed R. Mahfouz Bone reconstruction and orthopedic implants
JP6373046B2 (ja) * 2014-04-15 2018-08-15 株式会社パスコ 携帯型撮影装置及び撮影プログラム
EP3344514B1 (en) * 2015-09-04 2020-11-11 Gatekeeper Systems, Inc. Estimating motion of wheeled carts
CA3008479C (en) 2015-12-16 2022-10-18 Mohamed R. Mahfouz Imu calibration
US10352962B2 (en) * 2016-12-29 2019-07-16 BioMech Sensor LLC Systems and methods for real-time data quantification, acquisition, analysis and feedback
FR3069649B1 (fr) * 2017-07-26 2021-01-01 Sysnav Procede de calibration d'un magnetometre

Similar Documents

Publication Publication Date Title
JP2019509073A5 (ja)
EP3795109B1 (en) A method of calibrating an inertial measurement unit
JP5399630B2 (ja) 人の動作を決定する方法及び装置
JP4998364B2 (ja) 視線検出装置および方法、並びに、プログラム
JP2012503194A (ja) 加速度計からの測定値を処理する方法
JP6218991B2 (ja) 内視鏡の状態推定装置の作動方法および内視鏡システム
JP6191145B2 (ja) オフセット推定装置及びプログラム
US20170307380A1 (en) Optical inertial measurement apparatus and method
EP2795577B1 (en) Three dimension measurement method, three dimension measurement program and robot device
CN106709222A (zh) 基于单目视觉的imu漂移补偿方法
KR101725654B1 (ko) 호흡 모니터링 장치 및 그 방법
CN112528957A (zh) 人体运动基础信息检测方法、系统及电子设备
Kyrarini et al. Comparison of vision-based and sensor-based systems for joint angle gait analysis
JP4845068B2 (ja) デッドレコニング装置
EP3227634B1 (en) Method and system for estimating relative angle between headings
US10016336B2 (en) Cardiopulmonary resuscitation (CPR) feedback systems and methods
JP3956302B2 (ja) 構造物の損傷部位検出装置、及び構造物の損傷部位検出方法
EP3542719B1 (en) Information processing system, information processing device and information processing method
US20150032409A1 (en) Method and apparatus for calculating azimuth
Lajimi et al. A comprehensive filter to reduce drift from Euler angles, velocity, and position using an IMU
JP2020137801A (ja) 人等の姿勢推定装置
US20170281058A1 (en) Respiratory monitoring apparatus, method and device
KR20200042162A (ko) 다축 진동 센서로 감지되는 진동의 방향 사상 장치 및 그 방법
Taneda et al. Measurement of Dynamic State of Landslide Disaster
CN109709804A (zh) 一种随动系统的姿态检测方法