JP2019509073A5 - - Google Patents
Download PDFInfo
- 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
Links
- 238000001514 detection method Methods 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 3
- 239000000284 extract Substances 0.000 claims description 2
- 238000005259 measurement Methods 0.000 claims 20
- XEEYBQQBJWHFJM-UHFFFAOYSA-N iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 claims 8
- 229910052742 iron Inorganic materials 0.000 claims 4
- 238000000605 extraction Methods 0.000 claims 1
- 238000001356 surgical procedure Methods 0.000 claims 1
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のステップとして、静止中の前記慣性測定ユニットからデータを収集するステップと、
第2のステップとして、前記慣性測定ユニットの3つの直交軸周りで前記慣性測定ユニットを再位置決め中に前記慣性測定ユニットからデータを収集するステップと、
前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて複数のジャイロスコープを校正するステップと、
前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて複数の磁力計を校正するステップと、
前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて複数の加速度計を校正するステップと、
含み、
前記複数の磁力計を校正するステップが、歪み検出用パラメータを抽出することと、前記抽出したパラメータを用いて、前記慣性測定ユニットの局所場内に磁気歪みが存在するかを判定することと、を含む、方法。 - 前記歪み検出用パラメータの抽出では、(1)前記慣性測定ユニットの運動は、前記慣性測定ユニットを構成する前記複数の加速度計、前記複数のジャイロスコープ、および前記複数の磁力計のすべてにより検出可能である、(2)前記複数の磁力計のそれぞれの角度および長さは、略同一の値を有する、(3)複数の磁力計のベクトルはそれぞれ、大きさが略一致する、(4)校正された磁力計のベクトルと校正された加速度計のベクトルとの間の角度は、変化しないものとする、(5)校正後の前記複数の磁力計の半径は、1に略等しい、ならびに(6)前記複数の磁力計のうちの異なる磁力計を用いて計算された四元数は、略等しい、という前提のうちの少なくとも1つを採用する、請求項1に記載の方法。
- 前記慣性測定ユニットの運動は、前記慣性測定ユニットを構成する前記複数の加速度計、前記複数のジャイロスコープ、および前記複数の磁力計のすべてにより検出可能である、という前記前提からの逸脱が、運動異常の決定となる、請求項2に記載の方法。
- (2)前記複数の磁力計のそれぞれの角度および長さは、略同一の値を有する、(3)複数の磁力計のベクトルはそれぞれ、大きさが略一致する、(4)校正された磁力計のベクトルと校正された加速度計のベクトルとの間の角度は、変化しないものとする、(5)校正後の前記複数の磁力計の半径は、1に略等しい、ならびに(6)前記複数の磁力計のうちの異なる磁力計を用いて計算された四元数は、略等しい、という前記前提のうちのいずれか1つからの逸脱が、磁気異常の決定となる、請求項3に記載の方法。
- 前記複数のジャイロスコープを校正するステップが、算術平均によって各ジャイロスコープのバイアスを決定することを含む、請求項1に記載の方法。
- 前記複数の磁力計を校正するステップが、任意の軟化鉄歪みが存在するか、および、任意の硬化鉄歪みが存在するか、の少なくとも一方を判定することを含む、請求項1に記載の方法。
- 任意の軟化鉄歪みが存在するか、および、任意の硬化鉄歪みが存在するか、の少なくとも一方を判定することが、前記複数の磁力計から収集された前記データに対して多次元楕円フィッティング関数を利用することを含む、請求項6に記載の方法。
- 前記複数の磁力計を校正するステップが、基準整列からの前記磁力計間の整列差を考慮することを含む、請求項1に記載の方法。
- 前記複数の磁力計を校正するステップが、新しい基準整列に対して前記複数の磁力計を校正することを含む、請求項1に記載の方法。
- 前記複数の加速度計を校正するステップが、前記第2のステップにおいて前記複数の加速度計から収集された前記データに対して多次元楕円フィッティング関数を適用することを含む、請求項1に記載の方法。
- 前記複数のジャイロスコープを校正するステップが、歪み検出用パラメータを抽出することと、前記抽出したパラメータを用いて、運動異常が存在するかを判定することと、を含む、請求項1に記載の方法。
- 前記複数の加速度計を校正するステップが、運動状態を表す値に関して、前記第2のステップにおいて前記複数の加速度計から収集された前記データが前記第1のステップにおいて前記複数の加速度計から収集された前記データよりも大きな値を有することを確認することを含む、請求項1に記載の方法。
- 前記複数のジャイロスコープを校正するステップが、運動状態を表す値に関して、前記第2のステップにおいて前記複数のジャイロスコープから収集された前記データが前記第1のステップにおいて前記複数のジャイロスコープから収集された前記データよりも大きな値を有することを確認することを含む、請求項1に記載の方法。
- 前記複数の磁力計を校正するステップが、運動状態を表す値に関して、前記第2のステップにおいて前記複数の磁力計から収集された前記データが前記第1のステップにおいて前記複数の磁力計から収集された前記データよりも大きな値を有することを確認することを含む、請求項1に記載の方法。
- 前記複数の磁力計を校正するステップが、前記第2のステップにおいて前記複数の磁力計から収集された前記データに対して多次元楕円フィッティング関数を適用することを含む、請求項1に記載の方法。
- 前記複数の磁力計を校正するステップが、前記第2のステップにおいて前記複数の磁力計から収集された前記データから、配向出力の四元数を計算することを含む、請求項1に記載の方法。
- 前記複数の磁力計を校正するステップが、前記計算した配向出力の四元数間の角度を計算することを含む、請求項16に記載の方法。
- 前記複数の磁力計を校正するステップが、前記第2のステップにおいて前記複数の磁力計から収集された前記データに対して磁力計半径計算を適用することにより、磁気異常が存在するかを判定することを含む、請求項1に記載の方法。
- 前記磁気異常が存在する場合は、前記磁気異常の強度を計算する、請求項18に記載の方法。
- 複数のジャイロスコープ、複数の磁力計および複数の加速度計を有した慣性測定ユニットであって、
前記慣性測定ユニットは、静止中の前記慣性測定ユニットからデータを収集する第1のステップと、前記慣性測定ユニットの3つの直交軸周りで前記慣性測定ユニットを再位置決め中に前記慣性測定ユニットからデータを収集する第2のステップと、が実行され、
前記複数のジャイロスコープは、前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて校正されたものであり、
前記複数の磁力計は、前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて校正されたものであり、
前記複数の加速度計は、前記第1のステップおよび前記第2のステップにおいて収集した前記データを用いて校正されたものであり、
前記複数の磁力計の校正においては、歪み検出用パラメータを抽出し、前記抽出したパラメータを用いて前記慣性測定ユニットの局所場内に磁気歪みが存在するか判定される慣性測定ユニット。 - 手術ナビゲーションシステムの一部として組み込まれた請求項20に記載の慣性測定ユニット。
- 手術ナビゲーションで用いられるように構成された請求項20に記載の慣性測定ユニット。
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)
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)
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 |
-
2016
- 2016-12-16 CA CA3008479A patent/CA3008479C/en active Active
- 2016-12-16 EP EP20205982.0A patent/EP3795109B1/en active Active
- 2016-12-16 KR KR1020187020445A patent/KR102321695B1/ko active IP Right Grant
- 2016-12-16 WO PCT/US2016/067387 patent/WO2017106794A1/en active Application Filing
- 2016-12-16 ES ES16876874T patent/ES2869524T3/es active Active
- 2016-12-16 CN CN201680079763.7A patent/CN109069067B/zh active Active
- 2016-12-16 AU AU2016369607A patent/AU2016369607B2/en active Active
- 2016-12-16 CA CA3171029A patent/CA3171029A1/en active Pending
- 2016-12-16 JP JP2018530694A patent/JP6971234B2/ja active Active
- 2016-12-16 EP EP16876874.5A patent/EP3389490B1/en active Active
- 2016-12-16 ES ES20205982T patent/ES2931044T3/es active Active
-
2017
- 2017-07-31 US US15/664,342 patent/US10852383B2/en active Active
-
2019
- 2019-09-19 AU AU2019232853A patent/AU2019232853B2/en active Active
-
2020
- 2020-07-13 AU AU2020205220A patent/AU2020205220B2/en active Active
- 2020-09-16 US US17/022,488 patent/US11435425B2/en active Active
-
2022
- 2022-08-15 US US17/887,990 patent/US11946995B2/en active Active
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) | 一种随动系统的姿态检测方法 |