JP2019525335A - 空間内で物体を位置決めする装置 - Google Patents

空間内で物体を位置決めする装置 Download PDF

Info

Publication number
JP2019525335A
JP2019525335A JP2019503478A JP2019503478A JP2019525335A JP 2019525335 A JP2019525335 A JP 2019525335A JP 2019503478 A JP2019503478 A JP 2019503478A JP 2019503478 A JP2019503478 A JP 2019503478A JP 2019525335 A JP2019525335 A JP 2019525335A
Authority
JP
Japan
Prior art keywords
unit
magnetometer
output
phase
inductance coil
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.)
Pending
Application number
JP2019503478A
Other languages
English (en)
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 JP2019525335A publication Critical patent/JP2019525335A/ja
Pending legal-status Critical Current

Links

Classifications

    • 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/1113Local tracking of patients, e.g. in a hospital or private home
    • A61B5/1114Tracking parts of the body
    • 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/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/18Stabilised platforms, e.g. by gyroscope
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D21/00Measuring or testing not otherwise provided for
    • G01D21/02Measuring two or more variables by means not covered by a single other subclass
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F1/00Details not covered by groups G06F3/00 - G06F13/00 and G06F21/00
    • G06F1/04Generating or distributing clock signals or signals derived directly therefrom
    • G06F1/12Synchronisation of different clock signals provided by a plurality of clock generators
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F1/00Details not covered by groups G06F3/00 - G06F13/00 and G06F21/00
    • G06F1/16Constructional details or arrangements
    • G06F1/1613Constructional details or arrangements for portable computers
    • G06F1/1633Constructional details or arrangements of portable computers not specific to the type of enclosures covered by groups G06F1/1615 - G06F1/1626
    • G06F1/1684Constructional details or arrangements related to integrated I/O peripherals not covered by groups G06F1/1635 - G06F1/1675
    • G06F1/1694Constructional details or arrangements related to integrated I/O peripherals not covered by groups G06F1/1635 - G06F1/1675 the I/O peripheral being a single or a set of motion sensors for pointer control or gesture input obtained by sensing movements of the portable computer
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F1/00Details not covered by groups G06F3/00 - G06F13/00 and G06F21/00
    • G06F1/26Power supply means, e.g. regulation thereof
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F3/00Input arrangements for transferring data to be processed into a form capable of being handled by the computer; Output arrangements for transferring data from processing unit to output unit, e.g. interface arrangements
    • G06F3/01Input arrangements or combined input and output arrangements for interaction between user and computer
    • G06F3/011Arrangements for interaction with the human body, e.g. for user immersion in virtual reality
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F3/00Input arrangements for transferring data to be processed into a form capable of being handled by the computer; Output arrangements for transferring data from processing unit to output unit, e.g. interface arrangements
    • G06F3/01Input arrangements or combined input and output arrangements for interaction between user and computer
    • G06F3/03Arrangements for converting the position or the displacement of a member into a coded form
    • G06F3/033Pointing devices displaced or positioned by the user, e.g. mice, trackballs, pens or joysticks; Accessories therefor
    • G06F3/0346Pointing devices displaced or positioned by the user, e.g. mice, trackballs, pens or joysticks; Accessories therefor with detection of the device orientation or free movement in a 3D space, e.g. 3D mice, 6-DOF [six degrees of freedom] pointers using gyroscopes, accelerometers or tilt-sensors
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F3/00Input arrangements for transferring data to be processed into a form capable of being handled by the computer; Output arrangements for transferring data from processing unit to output unit, e.g. interface arrangements
    • G06F3/01Input arrangements or combined input and output arrangements for interaction between user and computer
    • G06F3/03Arrangements for converting the position or the displacement of a member into a coded form
    • G06F3/033Pointing devices displaced or positioned by the user, e.g. mice, trackballs, pens or joysticks; Accessories therefor
    • G06F3/038Control and interface arrangements therefor, e.g. drivers or device-embedded control circuitry
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B7/00Measuring arrangements characterised by the use of electric or magnetic techniques
    • G01B7/004Measuring arrangements characterised by the use of electric or magnetic techniques for measuring coordinates of points
    • 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
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F2200/00Indexing scheme relating to G06F1/04 - G06F1/32
    • G06F2200/16Indexing scheme relating to G06F1/16 - G06F1/18
    • G06F2200/163Indexing scheme relating to constructional details of the computer
    • G06F2200/1637Sensing arrangement for detection of housing movement or orientation, e.g. for controlling scrolling or cursor movement on the display of an handheld computer
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/30Assessment of water resources

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Human Computer Interaction (AREA)
  • Health & Medical Sciences (AREA)
  • Electromagnetism (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Environmental & Geological Engineering (AREA)
  • Geology (AREA)
  • Computer Hardware Design (AREA)
  • Manufacturing & Machinery (AREA)
  • Dentistry (AREA)
  • Biomedical Technology (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Molecular Biology (AREA)
  • Medical Informatics (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Surgery (AREA)
  • Pathology (AREA)
  • Biophysics (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Physiology (AREA)
  • Gyroscopes (AREA)
  • Measuring Magnetic Variables (AREA)
  • Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
  • Position Input By Displaying (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

本発明は、計測装備に関連しており、6自由度で空間を自由に移動する物体の座標及び角度値を計測する手段を作るのに使用できる。本発明は、特に、訓練システム、ロボット工学、ならびに拡張仮想現実及び複合現実システムにおいて、座標入力装置としてヒューマン−マシンインターフェイスに適用できる。技術成果は、センサを備えているプラットフォームの移動に起因する重力ベクトルの方向の計測誤差を無くすことによって計測精度を向上させるものである。水平な平面内に静止して配置されているインダクタンスコイルと、インダクタンスコイルの電源と、計算ユニットと、移動している物体上に配置されており、3成分磁力計と、3成分加速度計と、3成分ジャイロスコープと、を有しているセンサを備えているプラットフォームと、を有し、インダクタンスコイルの電源は、クロック発生器によって制御されているコイル電流レギュレータを有しており、計算ユニットは、磁力計のクロッキング及びインダクタンスコイルによって発生した磁界パルスの位相への磁力計の計測位相の同期を確実にする位相同期ループを実現するように構成されている請求される装置が存在する。【選択図】 図1

Description

本発明は、計測装備に関連しており、6自由度で空間を自由に移動する物体の座標及び角度値を計測する手段を作るのに使用できる。本発明は、特に、訓練システム、ロボット工学、ならびに拡張仮想現実及び複合現実システム、また、ゲーム産業(マニピュレータ、ゲームコントローラ等として)、製造部門(工業装備作業部品を位置決めする装置、プロセス制御)、及びCAD設計(入力システム、設計プロセス制御)において、座標入力装置としてヒューマン−マシンインターフェイスに適用可能である。
空間内で物体を位置決めする装置が知られている(特許文献1、Chernyshov E.S.、G01C21/08、2015年2月27日公開)。必須の特徴の組についてのこの発明は、請求している発明に最も近く、プロトタイプのために採用されている。既知の装置は、インダクタンスコイル(磁界源)、制御電流レギュレータ、デジタル3成分磁力計、デジタル3成分加速度計、及び計算ユニットからなる。既知の装置は、加速度計によって重力ベクトルを計測し、磁力計によって地球の磁界の誘導ベクトル及び水平面内に静止して配置されているインダクタンスコイルの磁界誘導ベクトルを計測することによって物体の位置を求める。
ロシア国特許出願公開第2542793号明細書
Raab F.、Blood E.、Steiner O.、Jones H.、Magnetic position and orientation tracking system(磁気位置及び方向追跡システム)、IEEE Transactions on Aerospace and Electronics Systems、Vol.AES−15、No.5、1979年9月、P.709〜717 Zalmanzon L.A.、Fourier、Walsh、Haar transforms and their application in control,communication and other fields(フーリエ、ウォルシュ、ハール変換及び制御、通信、及びその他の分野でのその応用)、M.:Science.Ch.ed.phys.−mat.lit、1989年、P496 Chye E.U.、Chernyshov E.S.、Magnetic inertial method for determining the position and orientation of an object(物体の位置及び方向を求める磁性慣性法)、Bulletin of Pacific National University、2014年、No.1(32)、P69〜78 Chernyshov E.S.、Otchesky S.A.、Microelectromechanical systems for tracking movements(運動追跡のための微小電子機械システム)、Current issues in scientific work and educational activities:a collection of scientific papers on the materials of the International Scientific and Practical Conference on January 31、2013:in 13 parts、Part 8、Tambov:Publishing house of Tambov Regional Public Organization Business−Science−Society、2013年、P147〜148 Yaroslavsky L.P.、Introduction to digital image processing(デジタル画像処理入門)、M.:Sov.radio、1979年、P312 Zhelamskii M.V.、Features of the construction of a positioning field for local navigation in enclosed spaces(閉空間内での局所的移動のため位置決め場の構成の特徴)、Measurement Techniques、2014年、No.7、P40〜45、Zhelamskii M.V.、Features of the construction of a positioning field for local navigation in enclosed spaces(閉空間内での局所的移動のため位置決め場の構成の特徴)、Measurement Techniques、2014年、Vol.57、No.7、P.791〜799
プロトタイプの欠点は、移動した時にセンサを備えているプラットフォームにおける自体の加速度の存在に起因する重力ベクトル方向の加速度計による計測誤差の存在による低い動的精度に帰着させることができる。また、計算ユニットと電流安定器との間の通信線の存在は、装置の人間工学的設計に悪影響があり、物体の移動の自由を制限するかもしれない。
本発明の目的は、動的計測精度が向上し、人間工学が向上し、機能(拡張性及びモジュール性)が向上していることでプロトタイプとは異なる、移動している物体の位置及び方向を求めるための、構成が単純で使用が容易な装置を作ることである。
技術成果は、センサを備えているプラットフォームの移動に起因する重力ベクトルの方向の計測誤差を無くすことによって計測精度を向上させるものである。
重力ベクトルの方向の計測の誤差を無くすことは、計測値が加速度計の計測値の修正に以降で使用される3成分ジャイロスコープをセンサを備えている移動プラットフォームが追加で備えることによって達成される。
請求される発明を使用して達成される追加の効果は、計算ユニットと電源との間の通信線が不要になることである。
計算ユニットと電源との間の通信線が不要になることは、所与の周波数を使用して制御コイル電流レギュレータに電流反転信号を供給するクロック発生器を電源が追加で備え、磁力計のクロッキング及び磁力計の計測位相のインダクタンスコイルによって発生する磁界パルスの位相との同期の保証のための位相同期ループユニットを計算ユニットが追加で備えることによって達成される。
請求される装置は、水平な平面内に静止して配置されているインダクタンスコイルと、インダクタンスコイルの電源と、計算ユニットと、移動している物体上に配置されており、3成分磁力計と、3成分加速度計と、3成分ジャイロスコープと、を有しているセンサを備えているプラットフォームと、を有し、インダクタンスコイルの電源は、クロック発生器によって制御されているコイル電流レギュレータを有しており、計算ユニットは、磁力計のクロッキング及びインダクタンスコイルによって発生した磁界パルスの移相への磁力計の計測位相の同期を確実にする位相同期ループを実現するように構成されている。
特定の実施態様において、計算ユニットは、磁界周波数成分選択ユニットと;磁力計の計測用の位相同期ループユニットと;センサを備えているプラットフォームの方向角度を計算するユニットと;センサを備えているプラットフォームの回転補償ユニットと;センサを備えているプラットフォームの座標計算ユニットと、を有していてもよい。
他の特定の実施態様において、クロック発生器の出力は、電流レギュレータの入力に接続されており、電流レギュレータの出力は、インダクタンスコイルの端子に接続されている。
他の特定の実施態様において、磁力計の出力は、磁界周波数成分選択ユニットの入力に接続されている。
他の特定の実施態様において、磁界周波数成分選択ユニットの第1の出力は、位相同期ループ周波数制御ユニットの入力に接続されており、第2の出力は、回転補償ユニットの第1の入力に接続されており、第3の出力は、方向角度計算ユニットに接続されている。
他の特定の実施態様において、位相同期ループ周波数制御ユニットの出力は、磁力計の入力に接続されている。
他の特定の実施態様において、ジャイロスコープの出力は、方向角度計算ユニットの第2の入力に接続されている。
他の特定の実施態様において、加速度計の出力は、方向角度計算ユニットの第3の入力に接続されている。
他の特定の実施態様において、方向角度計算ユニットの出力は、回転補償ユニットの第2の入力に接続されており、その出力は、座標計算ユニットの入力に接続されている。
図1は、装置の模式的な構造の図である。 図2は、時間に対するインダクタンスコイル電流のグラフである。 図3は、数個の磁界源及び数個の独立している位置決めされる物体を有しているシステムのトポロジである
請求される装置は、水平な平面内に静止して配置され、所与の周波数を備えているクロック発生器3から電流の極性を変更する信号を受信する制御電流レギュレータ2に接続されているインダクタンスコイル1(磁界源)からなる。制御電流レギュレータ2は、クロック発生器3と共に、インダクタンスコイル1の電源を構成している。
デジタル3成分磁力計5、ジャイロスコープ6、及び加速度計7が、プラットフォーム8上に配置されている。センサ8を備えているプラットフォームは、移動している物体に剛性をもって固定されている。磁力計5、ジャイロスコープ6、及び加速度計7は、計算ユニット14とやり取りし;計算ユニット14は、磁界周波数成分選択ユニット9;位相同期ループユニット10;センサを備えているプラットフォームの方向角度計算ユニット11;センサを備えているプラットフォームの回転補償ユニット12;及びセンサを備えているプラットフォームの座標計算ユニット13を有している。磁力計5の出力は、磁界周波数成分選択ユニット9の入力に接続されており、その第1の出力は、位相同期ループユニット10の入力に接続されており、第2の出力は、回転補償ユニット12の第1の入力に接続されており、第3の出力は、方向角度計算ユニット11に接続されており、位相同期ループユニット10の出力は、磁力計5の入力に接続されており、ジャイロスコープ6の出力は、方向角度計算ユニット11の第2の入力に接続されており、加速度計7の出力は、方向角度計算ユニット11の第3の入力に接続されており、方向角度計算ユニット11の出力は、回転補償ユニット12の第2の入力に接続されており、その出力は、座標計算ユニット13の入力に接続されている。
誘導コイル1は、絶縁されている電線を円柱状のベース上に巻くことによって作ったり、印刷回路基板上で導体を同心状に巻いて製造された平面状のコイルの形態で作ったり、他の方法で作ったりすることができる。その場合、強磁性体のコアの使用は好ましくないが、それは、地球磁界の著しい局所的な歪みにつながるからである。しかし、コイルが小さく、装置の動作時に、センサを十分にコイルから離すことができる場合には許容できる。
インダクタンスコイル1の直径、巻数、及び導体の断面は、装置の作業領域に必要な半径、電力消費、ならびにコイルの重量及び大きさを確保するように、解決する問題に基づいて決められる。一般的な場合、巻きの直径及び数の増加は、コイル電流が比例して減少せずに、作業領域の増加につながり、同時に、重量及び大きさが減少し、コイルの能動的抵抗の増加に比例して電力消費が増加する。エネルギー消費を減少させるためには、導体の断面を増加させることが必要であって、それがまた重量及び大きさを減少させ、コイルの原価に際だって影響するかもしれない。
作業領域は、センサを備えているプラットフォーム8の位置決めが行われるインダクタンスコイル1の周囲の空間の領域を意味する。作業領域の大きさは、インダクタンスコイル1、電源4、及び磁力計5の特性だけでなく、要求される計測精度に依存する。一次近似において、計測誤差は、磁力計からインダクタンスコイル1までの距離の2乗に比例し(非特許文献1)、そのため、要求される計測精度を保証するためには、装置の作業領域の大きさを制限する必要がある。作業領域の外側では、計測の精度は、1個または数個の座標において要求される値よりも低くなる。さらに距離が増加すると、磁力計で計測される磁界の誘導値が、磁力計の感度/誤差レベル未満へ減少することになり、それによって、センサを備えているプラットフォームの座標を求めることができなくなる。
インダクタンスコイル1の時定数も、重要な特性であるが、それは、時定数がコイル電流極性切換の期間を決め、それが今度は、装置の実現可能な最大計測周波数に影響するからである。時定数を減少させること、つまり、インダクタンスを減少させて、及び/または能動的電気抵抗を増加させて、極性切換の期間を減少させることが必要である。
電流レギュレータ2の制御部及びクロック発生器3は、既知の構成に従って、個別の電子部品上で組み立てる、またはマイクロコントローラを使用して実装することができる。第2の場合、クロック発生器は、マイクロコントローラのサブプログラムを表すことになる。
磁力計5は、MEMS(微小電気機械システム)技法を使用したデジタル出力を備えているチップの形態、または、3個の直交する感知素子だけでなく、増幅及びアナログ−デジタル信号変換回路を含んでいる組み立て品の形態で作られている任意の既知の型式(磁気抵抗センサ、ホール効果センサ)の3成分磁界誘導センサで表すことができる。前提条件は、磁力計が、外部信号で計測を開始する単一の計測モードを有することである。磁力計の適切なモデルは、STMicroelectronics LIS3MDL、MEMSIC MMC3416xPJ、及び同様なモデルである。
ジャイロスコープ6及び加速度計7は、MEMS技法に従って作られており、デジタル出力を備えているチップの形態の3成分センサを表している。
原価、質量、及び大きさについて、最も好ましい選択肢は、3成分磁力計、3成分ジャイロスコープ、及び3成分加速度計を含んでいる、単一のデジタルMEMSチップの形態に作られている、複合センサの使用である。そのようなセンサは、たとえば、STMicroelectronics LSM9DS1である。
センサを備えているプラットフォーム8は、磁力計5、ジャイロスコープ6、及び加速度計7が配置されているプリント回路基板を表している。MEMS技法によって作られているデジタルセンサを使用する場合、プラットフォーム8は、15×15×3mm未満の寸法とすることができる。
計算ユニット14は、マイクロコントローラまたはパーソナル/シングルボードコンピュータで表すことができるのに対して、計算ユニットの内部ユニット9、10、11、12、及び13はサブプログラムを表している。計算ユニットは、空間内の所与の点での人工磁界ベクトルの値の情報に基づいて物体の座標を求めるアルゴリズムを、物体の方向を求めるアルゴリズムと共に実装する。
装置の電力を組織化する様々な方法がある。計算ユニットの電力ユニット(図1には示していない)は、計算ユニットと同じ筐体に両方を配置することも、それとは別個に配置することもできる。計算ユニットがパーソナルコンピュータによって表される場合、要求される特性を備えている電源ユニットを概して有している。計算ユニットは、センサにも電力を供給できる。
請求される装置は、以下のように動作する。
制御電流レギュレータ2は、コイル1に、交互の正及び負の極性の電流信号i(t)を供給する(図2)。信号i(t)の極性は、クロック発生器3によって発生する周期的な制御信号によって決まる。コイル1を通過する電流が、磁界を発生する。コイル1の人工磁界が、地球磁界に追加され、磁力計5が、総磁界の磁気誘導ベクトルを計測する。ジャイロスコープ6は、センサを備えているプラットフォームの角速度を計測するのに対して、加速度計7は、センサを備えているプラットフォームに作用している重力ベクトルを計測する。
磁力計5の最高計測周波数fmagは、磁界周波数成分選択ユニット9及び位相同期ループユニット10の正しい動作のためには、以下の条件を満たさなければならない。
ここで、Tはインダクタンスコイル1の信号周期である(図2参照)。
ジャイロスコープ6及び加速度計7の計測周波数は標準化されておらず、問題を解決するのに任意の適切なものとすることができる。たとえば、人間の動きの効率的なデジタル化のためには、計測周波数は200Hzで十分である。
センサ5、6、及び7のデジタル形態での読み取り値は、計算ユニット14に送信される。
簡略化のために、センサ5、6、及び7の座標系は、移動プラットフォーム8に関連付けられている座標系と一致していることを仮定している。そうでない場合、センサの読み取り値は、計算ユニット14において、移動プラットフォームに関連付けられている単一の座標系で表されなければならない。
計算ユニットは、センサを備えているプラットフォーム8の座標及び方向を求めるために以下の動作を行う。
磁界周波数成分選択ユニット9は、インダクタンスコイル1の信号周期の整数倍(少なくとも1周期)について、磁力計5の各軸の計測値の累積値を生成し、それから、磁界の定数成分−地球磁界の誘導ベクトル及び、磁界の変数成分−誘導コイルの磁界誘導ベクトルBを選択する。ウォルシュ関数(非特許文献2)が基本となるフーリエ変換が、この目的のために使用される。他の変換方法を使用してもよい。
変換の結果、磁力計5の計測値の3軸に対応している磁界変数成分の3成分の各々の振幅と位相の値が得られる。
この場合、成分の位相は、その符号を以下のように特徴付けている:2個の計測成分の位相が一致した場合、成分は同じ符号を有しており;位相がπ(半周期)だけ異なる場合、成分は反対の符号を有しており;πの位相跳躍は、成分の符号の変化に該当している。したがって、ベクトルBは、2個の反対の方向を持ち得る。ベクトルBの方向の明確な決定は、空間内でのセンサの位置及び方向に関連する位相の不明確さによって妨げられる。
位相の不明確さは、いくつかの方法によって無くすことができる。
具体的には、物体の初期の位置及び方向についての粗い事前情報を知ることができる(座標の所与の部分に位置し、所与の方向を有している)。そのような場合、位相の不明確さを、計測の開始後、即座に取り除くことができる。それから、位相同期ループユニット10は、センサを備えているプラットフォーム8がインダクタンスコイル1の磁界内にある限り、信号位相を追跡することになる。
他の選択肢は、インダクタンスコイル1の信号内の特定の時間パターンの使用であって、それによって計測された信号位相の曖昧さを求めることができる。最も簡単なパターンは、正及び負の信号パルスの異なる継続期間とすることができる。
磁界変数成分の3成分の各々の位相値が、磁力計の計測値の周波数を調整することによって、指定された信号位相と計測された信号位相との間の誤差を最小化するアルゴリズム(たとえば、PID制御アルゴリズム)が実行される位相同期ループユニット10にそれから送信される。
磁力計を、計測開始の外部信号によって単一の計測モードで起動すべきであって、その場合、計測開始のための信号生成周期を変更することによって、計算ユニットがその計測周波数を柔軟に変更可能である。
ユニット10の動作の結果、磁力計5計測値の周波数及び位相は、インダクタンスコイル1信号の周波数及び位相に対応することになる。
計算の次の段階において、地球の磁場の誘導ベクトルのB値は、ユニット9から方向角度計算ユニット11に転送され、方向角度計算ユニット11は、ジャイロスコープ6及び加速度計7の計測値も受信する。
加速度計7の計測値は、重力ベクトルを表している。使用されるセンサの低精度特性のせいだけでなく、様々な外乱(電子装備、振動、及びセンサを備えているプラットフォームの加速する移動からの取り込み)の影響のせいで、B及びGの値は、非常に雑音が多くなることがある。そのため、装置の動的特性を減少させることなく計測精度を改善するには、ベクトルB及びGの方向の相補フィルタリングのためにジャイロスコープ6の計測値を使用する必要がある。
回転行列(非特許文献3)を使用して、ジャイロスコープの計測値を積分することによって得られた角度でベクトルを回転させる。ジャイロスコープの計測期間及びベクトルB及びGの計測期間をTに等しくする。すると、再帰相補フィルタ(非特許文献4)は、次の形態を有することになる:
ここで、BEf−地球の磁界のフィルタリングされた誘導ベクトル;δ−フィルタ係数でδ<<1;W、W、W−それぞれ、x、y、及びz軸の周りの計測されたジャイロスコープ回転速度、T−ジャイロスコープの計測周期;R(W)−x軸を中心にした角度Wの回転の行列;R(W)−y軸を中心にした角度Wの回転の行列;R(W)−z軸を中心にした角度Wの回転の行列;Gf−フィルタリングされた重力ベクトル。
方向角度は、ベクトルBEf及びGfの方向において、既知の態様(非特許文献3)で計算される。
次に、物体の得られた方向角度が、回転補償ユニット12において、インダクタンスコイルの磁界誘導ベクトルBを、磁力計5の座標系から固定されているインダクタンスコイル1に関連付けられている座標系へ変換するために使用される。ベクトルBを、この目的のために、物体の方向の得られた角度とは反対の角度だけ回転される。ベクトルの回転は、回転行列を使用して実行される。
ここで、BS0−インダクタンスコイル1に関連付けられている座標系におけるインダクタンスコイルの磁界誘導ベクトル(φ=θ=ψ=0における);φ、θ、ψ−物体の方向の得られた角度(それぞれ、バンク、ピッチ、及びヨーの角度);R(−ψ)−z軸を中心とした−ψの角度の回転の行列;R(−θ)−y軸を中心とした−θの角度の回転の行列;R(−φ)−x軸を中心とした−φの角度の回転の行列。
それから、ベクトルBS0は、座標計算ユニット13に送信される。ベクトルBS0は、以下の形態を有しているとする。
インダクタンスコイル1は、水平に位置しているので、球面座標系におけるベクトルBS0の方向の方位角(インダクタンスコイル1座標系のx0y平面へのベクトル投影とx軸との間の角度)は、配置される物体の方位角座標φに一致する。
物体の残りの座標は、解析的に(非特許文献1)または表に固有の関数(非特許文献3)を使用して得ることができる。第2の場合、表は、インダクタンスコイル1の座標系の垂直なz軸(コイルの対称軸)を通過する垂直平面の点の配列の精度を表している。各点は、その点でインダクタンスコイルによって発生する磁気誘導ベクトルに関連付けられている。ベクトルの計算は、ビオサバールの法則を使用して行うことができる。大きさ及び方向がベクトルBS0に最も近い磁気誘導ベクトル、またその物体の座標を求めるための座標値を表内で見つける必要がある。それから、たとえば、共1次内挿法(特許文献5)を使用して、所望の物体座標を求めることができる。
装置の説明した構造及び動作の原理によって、位置決めされる物体の数の柔軟な増加及び装置の作業領域の拡大が可能になる。図3は、システムトポロジのオプションを示しており、数個の磁界源及び数個の独立しているセンサを備えているプラットフォームを示している。
最新のコンピュータ技術によって、センサを備えているプラットフォーム(位置22、23、24)の各々について独立している小さいコンピュータユニット(位置25、26、27)を使用できる。このアプローチは、計算ユニットとインダクタンスコイルの電源との間の通信線が無いことと共に、装置の構造を一切変更することなく、配置可能な物体の数を不定に増加させることを可能にする。
別個に配置されている数個のインダクタンスコイル(位置15、16、及び17)を使用して、装置の作業領域を拡大することができる。この場合、コイル信号は、数個のコイルの作業領域の間の境界の位置でそれらの混合を防止するために、周波数または時間によって分離されていなければならない。特定のコイルの信号の選択は、ウォルシュ関数(非特許文献2)の形態を元にしたフーリエ変換またはその他の方法を使用して実行することができる。
隣接しているインダクタンスコイルの信号間の不定な位相の差は、あるインダクタンスコイルの作業領域から他のインダクタンスコイルの作業領域に物体を移動させたときに装置の位相同期ループ周波数制御ユニットの非同期につながることがある。コイルの電源の信号は、この問題を無くすために、互いに同期していなければならない。
この目的を達成するための最も適切な方法は、制御コイル電流レギュレータ(位置18、19、及び20)を、必要な周波数及び位相の信号を生成する1個の共通のクロック発生器21の出力に接続することである。
一般的な場合、少なくとも4個の異なる信号の周波数(周波数分割)または位相(時分割)を有している磁界源の交番が、任意の大きさ及び形状の作業領域を作るために必要である(非特許文献6)。しかし、「不感」帯の存在が許される場合、2個または3個の異なる周波数/位相を有している磁界源の交番も可能である。
1 インダクタンスコイル
2 制御電流レギュレータ
3 クロック発生器
4 電源
5 磁力計
6 ジャイロスコープ
7 加速度計
8 センサを備えているプラットフォーム
9 磁界周波数成分選択ユニット
10 位相同期ループユニット
11 方向角度計算ユニット
12 回転補償ユニット
13 座標計算ユニット
14 計算ユニット
15 インダクタンスコイル1
16 インダクタンスコイル2
17 インダクタンスコイルN
18 制御電流レギュレータ1
19 制御電流レギュレータ2
20 制御電流レギュレータN
21 クロック発生器
22 センサを備えているプラットフォーム1
23 センサを備えているプラットフォーム2
24 センサを備えているプラットフォームM
25 計算ユニット1
26 計算ユニット2
27 計算ユニットM

Claims (9)

  1. 水平な平面内に静止して配置されているインダクタンスコイルと、
    インダクタンスコイルの電源と、
    計算ユニットと、
    移動している物体上に配置されており、3成分磁力計と、3成分加速度計と、3成分ジャイロスコープと、を有している、センサを備えているプラットフォームと、
    を有し、
    インダクタンスコイルの電源は、クロック発生器によって制御されているコイル電流レギュレータを有しており、計算ユニットは、磁力計のクロッキング及びインダクタンスコイルによって発生した磁界パルスの位相への磁力計の計測位相の同期を確実にする位相同期ループを実現するように構成されている、
    空間内で物体を位置決めする装置。
  2. 計算ユニットは、磁界周波数成分選択ユニットと、磁力計の計測用の位相同期ループを実現するユニットと、センサを備えているプラットフォームの方向角度を計算するユニットと、センサを備えているプラットフォームの回転補償ユニットと、センサを備えているプラットフォームの座標を計算するユニットと、を有している、請求項1に記載の装置。
  3. クロック発生器の出力は、電流レギュレータの入力に接続されており、電流レギュレータの出力は、インダクタンスコイル端子に接続されている、請求項1に記載の装置。
  4. 磁力計の出力は、磁界周波数成分選択ユニットの入力に接続されている、請求項2に記載の装置。
  5. 磁界周波数成分選択ユニットの第1の出力は、位相同期ループを実現するユニットの入力に接続されており、第2の出力は、回転補償ユニットの第1の入力に接続されており、第3の出力は、方向角度を計算するユニットに接続されている、請求項4に記載の装置。
  6. 位相同期ループを実現するユニットの出力は、磁力計の入力に接続されている、請求項4に記載の装置。
  7. ジャイロスコープの出力は、方向角度を計算するユニットの第2の入力に接続されている、請求項2に記載の装置。
  8. 加速度計の出力は、方向角度を計算するユニットの第3の入力に接続されている、請求項2に記載の装置。
  9. 方向角度を計算するユニットの出力は、回転補償ユニットの第2の入力に接続されており、その出力は、座標を計算するユニットの入力に接続されている、請求項2に記載の装置。
JP2019503478A 2016-07-18 2017-06-22 空間内で物体を位置決めする装置 Pending JP2019525335A (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
RU2016129260A RU2626755C1 (ru) 2016-07-18 2016-07-18 Устройство для определения положения объекта в пространстве
RU2016129260 2016-07-18
PCT/RU2017/050052 WO2018017000A1 (ru) 2016-07-18 2017-06-22 Устройство для определения положения объекта в пространстве

Publications (1)

Publication Number Publication Date
JP2019525335A true JP2019525335A (ja) 2019-09-05

Family

ID=59632435

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019503478A Pending JP2019525335A (ja) 2016-07-18 2017-06-22 空間内で物体を位置決めする装置

Country Status (8)

Country Link
US (1) US10540021B2 (ja)
EP (1) EP3486610A4 (ja)
JP (1) JP2019525335A (ja)
KR (1) KR20190028450A (ja)
CN (1) CN109416255B (ja)
RU (1) RU2626755C1 (ja)
SG (1) SG11201811805UA (ja)
WO (1) WO2018017000A1 (ja)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107421566B (zh) * 2017-08-25 2020-08-11 北京理工大学 一种无人车多源传感器信息仿真平台
DE102018005649A1 (de) * 2018-07-13 2020-01-16 Fachhochschule Dortmund Verfahren und Einrichtung zur 3D-Orientierungs- und 3D-Positionsbestimmung auf Basis einer einachsigen Spule und eines MARG-Sensors
CN111184345B (zh) * 2020-03-13 2024-06-25 常州市凯迪电器股份有限公司 电动桌安全运行的控制方法及其控制单元
CN111272168B (zh) * 2020-03-24 2022-03-29 哈尔滨工业大学 一种基于磁场特征矢量的定位方法、装置及系统
CN112710219B (zh) * 2021-01-21 2022-06-21 中北大学 一种面向城市地下空间的绝对位移检测方法
RU2767174C1 (ru) * 2021-04-09 2022-03-16 Федеральное государственное бюджетное образовательное учреждение высшего образования "Поволжский государственный технологический университет" Способ трекинга гибкого хирургического инструмента на основе инерциальных МЭМС датчиков

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04502515A (ja) * 1989-04-11 1992-05-07 アセンション テクノロジー コーポレーション 直流位置測定装置
JP2004093373A (ja) * 2002-08-30 2004-03-25 Japan Aviation Electronics Industry Ltd 位置姿勢測定装置
US20130157721A1 (en) * 2010-09-03 2013-06-20 Sony Ericsson Mobile Communications Ab Method for determining the relative position of devices
JP2015502527A (ja) * 2011-11-01 2015-01-22 クアルコム,インコーポレイテッド 方位データを改善するためのシステムおよび方法
JP2016505809A (ja) * 2012-11-05 2016-02-25 クアルコム,インコーポレイテッド 適応型スケールおよび/または重力推定

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA1220279A (en) * 1985-06-20 1987-04-07 Her Majesty The Queen In Right Of Canada As Represented By The Minister Of National Defence Of Her Majesty's Canadian Government Precision magnetometer orientation device
US5307072A (en) * 1992-07-09 1994-04-26 Polhemus Incorporated Non-concentricity compensation in position and orientation measurement systems
US5752513A (en) * 1995-06-07 1998-05-19 Biosense, Inc. Method and apparatus for determining position of object
RU2103664C1 (ru) * 1996-12-11 1998-01-27 Борис Михайлович Смирнов Устройство для дистанционного определения положения объекта (его варианты)
JP2000009409A (ja) * 1998-06-24 2000-01-14 Mitsubishi Electric Corp インダクタンス変化検出回路
RU2257546C1 (ru) * 2004-10-14 2005-07-27 Смирнов Борис Михайлович Устройство для определения углового положения подвижного объекта (варианты)
US20130326364A1 (en) * 2012-05-31 2013-12-05 Stephen G. Latta Position relative hologram interactions
RU2542793C1 (ru) * 2013-09-16 2015-02-27 Общество с ограниченной ответственностью "Континент-Тау" Устройство для определения положения объекта в пространстве
US10234306B2 (en) * 2014-07-11 2019-03-19 Sixense Enterprises Inc. Method and apparatus for synchronizing a transmitter and receiver in a magnetic tracking system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04502515A (ja) * 1989-04-11 1992-05-07 アセンション テクノロジー コーポレーション 直流位置測定装置
JP2004093373A (ja) * 2002-08-30 2004-03-25 Japan Aviation Electronics Industry Ltd 位置姿勢測定装置
US20130157721A1 (en) * 2010-09-03 2013-06-20 Sony Ericsson Mobile Communications Ab Method for determining the relative position of devices
JP2015502527A (ja) * 2011-11-01 2015-01-22 クアルコム,インコーポレイテッド 方位データを改善するためのシステムおよび方法
JP2016505809A (ja) * 2012-11-05 2016-02-25 クアルコム,インコーポレイテッド 適応型スケールおよび/または重力推定

Also Published As

Publication number Publication date
RU2626755C1 (ru) 2017-07-31
KR20190028450A (ko) 2019-03-18
WO2018017000A1 (ru) 2018-01-25
CN109416255B (zh) 2023-07-25
US10540021B2 (en) 2020-01-21
EP3486610A4 (en) 2020-04-01
EP3486610A1 (en) 2019-05-22
SG11201811805UA (en) 2019-01-30
US20190171301A1 (en) 2019-06-06
CN109416255A (zh) 2019-03-01

Similar Documents

Publication Publication Date Title
JP2019525335A (ja) 空間内で物体を位置決めする装置
JP2017510307A5 (ja)
US10151606B1 (en) Tracking position and movement using a magnetic field
Hu et al. A robust orientation estimation algorithm using MARG sensors
KR101210394B1 (ko) 지자기 검지장치
Fontaine et al. Sourceless human body motion capture
JP2011059091A (ja) 室内位置検出装置
Hoang et al. Measurement optimization for orientation tracking based on no motion no integration technique
RU2494345C1 (ru) Универсальный широкодиапазонный стенд для контроля измерителей угловой скорости
JP2013061309A (ja) カルマンフィルタ、状態推定装置、カルマンフィルタの制御方法、及びカルマンフィルタの制御プログラム
RU2542793C1 (ru) Устройство для определения положения объекта в пространстве
JP5457890B2 (ja) 方位検知装置
JP5144701B2 (ja) 磁界検知装置
JP5490576B2 (ja) 磁界検知装置
RU137953U1 (ru) Устройство для определения положения объекта в пространстве
JP5341861B2 (ja) 磁界検知装置
JP2011185866A (ja) 磁界検知装置
KR101948017B1 (ko) 3차원 좌표 획득 방법
JP4125059B2 (ja) 多軸傾斜検出装置
Li et al. A magnetic induction-based highly dynamic rotational angular rate measurement method
RU2629691C1 (ru) Способ автономного определения угловых положений объекта с шестью степенями свободы пространственного движения
JP5498196B2 (ja) 磁界検知装置
JPH09311762A (ja) 3次元操作検出装置
Wang et al. Application of rotation vector algorithm for SINS attitude updating
Bafghi et al. Optimized design of PM torquer for dynamically tuned gyroscope

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20191002

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191127

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201111

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201201

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20210301

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20210506

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210527

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20211130

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20220628