CN103575271B - 基于电控旋转磁场的电磁跟踪系统及方法 - Google Patents
基于电控旋转磁场的电磁跟踪系统及方法 Download PDFInfo
- Publication number
- CN103575271B CN103575271B CN201310516908.3A CN201310516908A CN103575271B CN 103575271 B CN103575271 B CN 103575271B CN 201310516908 A CN201310516908 A CN 201310516908A CN 103575271 B CN103575271 B CN 103575271B
- Authority
- CN
- China
- Prior art keywords
- magnetic field
- field source
- magnetic
- coordinate system
- sensor
- 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.)
- Expired - Fee Related
Links
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/00234—Surgical instruments, devices or methods, e.g. tourniquets for minimally invasive surgery
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B90/00—Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges
- A61B90/10—Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges for stereotaxic surgery, e.g. frame-based stereotaxis
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Molecular Biology (AREA)
- General Health & Medical Sciences (AREA)
- Biomedical Technology (AREA)
- Heart & Thoracic Surgery (AREA)
- Medical Informatics (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Animal Behavior & Ethology (AREA)
- Engineering & Computer Science (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Oral & Maxillofacial Surgery (AREA)
- Pathology (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
- Measuring Magnetic Variables (AREA)
Abstract
本发明属于电磁跟踪技术领域,具体为一种电控旋转磁场的电磁跟踪系统及方法。本发明由三轴磁传感器装置、磁场源装置、可控恒流源装置和控制处理显示装置组成。本发明用可控恒流源激励三个正交的线圈组成磁场源;控制处理显示装置通过控制恒流源装置输出的各路激励电流强度,使磁场源产生的合成磁感应强度最大值按照搜索策略进行扫描,并最终指向三轴磁传感器装置;根据两个磁场源扫描并最终指向三轴磁传感器所获得的两组角度信息以及它们中心点之间的距离信息,计算传感器六自由度的位置和姿态。本发明不依赖于某种假定的磁场模型或迭代算法,稳定性高,计算复杂度低,可应用于微创手术的导航,亦可运用于虚拟(增强)现实、三维超声成像等领域。
Description
技术领域
本发明属于电磁跟踪技术领域,具体涉及一种通过控制磁场源线圈激励电流实现磁场旋转的电磁跟踪的系统和方法。
背景技术
电磁跟踪是一种利用磁场源与磁传感器之间的磁场耦合关系,获得跟踪目标空间位置和空间姿态的方法,在微创手术导航中具有广泛的应用前景,成为目标跟踪领域的研究热点。相较于其他跟踪方式,电磁跟踪具有无损伤、无辐射、无遮挡问题、操作简便、定位准确、定位信息完备(可实现三维六自由度定位:三自由度位置和三自由度方向)等优点;但同时存在依赖理论磁场模型、迭代算法复杂、易受干扰等问题。针对传统磁跟踪方法存在的问题,本研究组提出了一种基于旋转磁场的电磁跟踪方法,该方法不依赖于磁场理论模型、采用非迭代的几何算法实现三维六自由度定位。与传统磁跟踪方法相比,本方法的算法简洁、运算速度快;通过简单的标定即可实现更高的定位精度。
磁场旋转可以通过机械方式实现,即机械扫描的搜索方式:根据通电螺线管产生的磁感应强度最大值沿轴线方向的原理,通过步进电机控制处于不同位置的两个螺线管旋转,当两个通电螺线管轴线指向传感器时,传感器可以分别检测到最大磁感应强度,然后根据两个螺线管之间的距离(已知)及螺线管由初始位置到指向传感器的旋转角度,通过几何方法可以计算出传感器的空间位置和姿态。
这种通过机械扫描实现旋转磁场电磁跟踪的方式能够准确定位,但其定位速度受到步进电机带动螺线管旋转速度的限制,系统的实时性较差;并且机械扫描只能在步进电机有限的旋转平面中进行,搜索灵活性较差。
发明内容
本发明的目的在于提出一种可以显著提高跟踪实时性和扫描灵活性的基于电控旋转磁场的电磁跟踪方法和系统。
本发明提出的电磁跟踪方法与系统,是通过电控旋转磁场实现电磁跟踪。本发明设计了一种由三个缠绕在软磁铁氧体磁芯上的、中心点重合且相互正交的线圈组成的磁场源模型,根据单线圈磁感应强度最大值方向为其轴线方向以及三轴合成的总磁感应强度最大值由单轴最大值合成的特性,通过控制三轴线圈激励电流实现合成的总磁感应强度指向的旋转,从而对跟踪目标(磁传感器)进行搜索定位。
本发明的特点之一在于不依赖于某种假定的磁场模型建立磁场源与磁传感器之间的耦合关系,避免了由于磁场源实际分布与理想磁场源不一致而产生的定位误差;本发明的特点之二在于采用非迭代的几何算法,计算复杂度低,不仅可大幅度提高定位速度,还避免了迭代算法可能收敛到局部最优解或发散等问题造成的系统不稳定。本发明的特点之三,在于通过快速改变磁场源三个正交线圈激励电流强度,实现合成的最大磁感应强度指向的快速自由改变,有效提高跟踪系统的实时性和搜索(扫描)的灵活性。
为了便于说明,先定义如表1所示的五组坐标系:
表1 坐标系定义
坐标系名称 | 描述 |
坐标系1 | 由磁场源1的初始位置和姿态定义的坐标系。组成磁场源1的三个线圈的轴线分别沿该坐标系的三个坐标轴。该坐标系也是系统坐标系,坐标系原点为(0,0,0) |
坐标系2 | 由磁场源2的初始位置和姿态定义的坐标系。组成磁场源2的三个线圈的轴线分别沿该坐标系的三个坐标轴。坐标系2的原点在系统坐标系中的坐标为(d,0,0),各坐标轴与系统坐标系中的相应坐标轴平行 |
坐标系 3 | 坐标系1的X轴旋转至磁场源1产生的磁感应强度最大值指向时所构成的坐标系 |
坐标系4 | 坐标系2的X轴旋转至磁场源2产生的磁感应强度最大值指向时所构成的坐标系 |
坐标系5 | 原点与三轴磁传感器的中心点重合,坐标轴方向分别与三轴磁传感器相应检测轴方向一致的坐标系 |
用Xn 、Yn 、Zn表示坐标系n的三个坐标轴,n=1,2,…,5。
描述三轴磁场传感器装置空间位置和姿态以及磁场源产生的合成磁感应强度最大值指向的角度定义如下:
经度角:指从坐标系1的原点到三轴磁传感器中心点之间的连线在X1Y1平面的投影与X1轴之间的夹角;或者磁场源产生的合成磁感应强度最大值指向在X1Y1平面的投影与X1轴之间的夹角。
纬度角:指从坐标系1的原点到三轴磁传感器中心点之间的连线与该连线在X1Y1平面的投影之间的夹角;或者磁场源产生的合成磁感应强度最大值指向与该指向在X1Y1平面投影之间的夹角。
本发明提出的电磁跟踪系统,由四部分构成:一个三轴磁传感器装置,由两组三轴正交线圈组成的、可以分别实现最大磁感应强度空间任意指向的磁场源装置,一个可控恒流源装置,一个控制处理显示装置。系统结构如图2所示。其中:
所述磁传感器装置,附着于跟踪目标,用于测量跟踪目标所在位置处三个正交方向的磁场。磁传感器装置中传感器的选择依据测量范围和精度的要求,可以采用磁阻传感器、霍尔效应传感器或磁通门传感器等。
所述磁场源装置,包括两个相对位置和姿态已知的磁场源,两个磁场源分别由缠绕在软磁性铁氧体磁芯上的三个中心点重合且相互正交的线圈组成;线圈需要保证很好的正交性和对称性,其中线圈的截面形状可采用方形或者圆形等。对三个线圈通电后,即可分别在每个线圈的轴线方向产生磁感应强度最大值;当所通电流强度变化时,磁感应强度最大值的大小也随之变化。由于三个正交的磁感应强度最大值可通过矢量合成的方法形成唯一的合成磁感应强度最大值,故通过分别控制三个正交线圈所通电流强度,即可实现对合成磁感应强度最大值指向的控制,即实现磁场旋转。磁场源需依据一定的搜索策略,通过磁场旋转搜索传感器,当传感器检测到最大磁感应强度时,说明合成磁感应强度最大值指向传感器;当一组正交线圈组成的磁场源的合成磁感应强度最大值指向传感器时,可以得到一组由三轴线圈激励电流强度确定的合成磁感应强度最大值指向在系统坐标系中的经纬度角;当两个磁场源产生的合成磁感应强度最大值分别指向传感器时,可以得到两组经纬度角,结合两个磁场源之间的相对位置和初始姿态,即可用几何方法求解传感器的空间位置和姿态。
所述恒流源装置,由恒流源及相关电路组成,为构成磁场源的线圈提供激励电流。
所述控制处理显示装置,由微处理器和显示器组成,用于采集磁传感器装置的输出并计算当前合成磁感应强度值,根据计算结果,通过控制磁场源线圈激励电流强度控制磁场源合成磁感应强度最大值方向的改变,并使合成磁感应强度最大值最终指向磁传感器;最后,依据下文所述的位置和姿态算法,计算出传感器六自由度的位置和姿态,输出并显示跟踪结果。
本发明中,所述三轴磁传感器装置,包括一个三轴分量磁传感器和一个信号调理/模拟-数字(AD)转换模块。三轴分量传感器分别用来检测所在位置三个正交方向X5、Y5和Z5的磁感应强度,其输出经后续信号调理/模拟-数字(AD)转换模块送入控制处理显示装置。
本发明中,所述磁场源装置,包括磁场源1和磁场源2,其组成和结构完全相同:均由三轴线圈组成。每个磁场源的三轴线圈分别缠绕在软磁铁氧体磁芯上,且中心点重合、相互正交。这样,在与磁场源中心点等距离的球面上,单轴线圈的磁感应强度最大值为该线圈的轴线位置,方向沿轴线方向,三轴线圈合成的总磁感应强度最大值由单轴最大值合成。两个磁场源中心点之间的距离为d,且三组对应线圈相互平行。
本发明中,所述可控恒流源装置,由恒流源、控制电路组成。恒流源输出的电流强度由控制处理显示装置控制。控制电路将恒流源输出的电流整形为脉冲形式,为磁场源装置的各线圈提供合适的激励电流,并且实现对构成磁场源1、2的两组线圈的交替激励。
本发明中,所述控制处理显示装置,由控制单元、算法单元和显示输出单元组成。控制单元包括两个部分:采样处理模块和激励电流控制模块。采样处理模块用于采样处理来自三轴磁场传感器装置的信号;激励电流控制模块控制可控恒流源装置对磁场源装置的各线圈提供合适强度的激励电流。算法单元一方面根据采样处理模块的输出数据计算当前三轴磁场传感器装置检测到的磁感应强度值,进而根据搜索策略决定组成磁场源各线圈的激励电流强度;另一方面,当磁场源装置中的两个磁场源形成的合成磁感应强度最大值分别指向磁传感器时,根据下文所述算法计算磁传感器的空间位置坐标和姿态。显示输出单元将磁传感器的定位信息显示/输出。
本发明提出的基于上述电磁跟踪系统的电磁跟踪方法,其步骤为(以磁场源1的搜索过程为例):三轴磁传感器装置测量其所在位置的三个正交方向上的磁感应强度值,送至控制处理显示装置;控制处理显示装置计算当前的合成磁感应强度值,并根据搜索策略控制可控恒流源装置输出适当强度的电流分别激励磁场源装置中磁场源1的三轴线圈,磁场源1的三轴线圈产生的磁感应强度最大值均沿各自轴向,并按照矢量合成的原理形成方向与各线圈激励电流强度相关的合成磁感应强度最大值;改变三个线圈的激励电流强度即可改变磁场源产生的合成磁感应强度最大值指向,对传感器进行搜索;当三轴磁传感器装置检测到最大磁感应强度时,表明由磁场源1产生的合成磁感应强度最大值指向磁传感器,根据此时磁场源装置的三轴线圈的激励电流强度,计算出此时磁感应强度最大值指向在坐标系1中的经纬度角。磁场源装置中磁场源2通过与磁场源1相似的步骤搜索并最终指向磁传感器装置,即获得另外一组经纬度角。根据所获得的两组经纬度角信息,结合磁场源装置中磁场源1和磁场源2中心点之间的距离d,即计算求得磁传感器装置的六自由度空间位置和空间姿态。
在确定磁场源三轴正交线圈激励电流强度方面,若要求磁场源产生的合成磁感应强度最大值指向的经纬度角为,,则构成磁场源的轴线为X轴、Y轴、Z轴的三个线圈的激励电流强度F1、F2、F3由式(1)、(2)决定:
(1)
(2)
所述的搜索策略在电扫描系统中具有高度的灵活性和实时性。为了简化问题,本发明以机扫系统中的常规搜索策略为例进行说明。假设三轴磁传感器在坐标系1中的位置用经纬度角(,)和距离R(坐标系1原点与三轴磁传感器中心点,即坐标系5原点之间的距离)定义。磁场源1三轴正交线圈的轴线方向分别为X1、Y1、Z1,在X1Y1Z1空间中,为了保证磁场源1产生的合成磁感应强度最大值指向遍历整个跟踪区域,可控制三个正交线圈的激励电流强度,使其先在一个面上搜索,如X1Y1平面(即,,,);通过改变激励电流F1、F2,使在范围内变化;当时,传感器可检测到最大磁感应强度值(此时磁场源产生的合成磁感应强度最大值指向传感器在X1Y1平面的投影);然后保持经度角不变,取,通过改变激励电流F3,使在范围内变化,当时,传感器检测可到最大磁感应强度值(此时磁场源产生的合成磁感应强度最大值指向传感器);这样,就获得了一组磁场源1产生的合成磁感应强度最大值指向传感器时的经纬度角(,)。磁场源2按照上述磁场源1的搜索方式进行搜索,并最终指向传感器时,可获得另一组经纬度角(,),然后根据两个磁场源之间的相对位置,通过几何算法即可获得三轴磁传感器的空间位置和姿态。
本发明提出的用于电控旋转磁场获得跟踪目标空间位置和姿态的算法,利用在上述磁场源装置通过搜索并使其产生的合成磁感应强度最大值最终指向三轴磁传感器后所获得的两组经纬度角:(,)、(,),以及两磁场源中心点之间的距离,通过式(3)~(5)计算传感器在坐标系1中的位置坐标(,,),设磁传感器在X1Y1(或X2Y2)平面内的投影(,,0)到磁场源1和磁场源2的距离分别为、,传感器的位置计算如下:
(3)
(4)
(5)
本发明提出的用于电扫描实现旋转磁场跟踪的待测物体空间姿态算法,即求解磁场源1的坐标系1(已知的系统坐标系)到传感器的坐标系5(表明磁传感器的姿态)的旋转。由于经纬度角(,)和(,)可表示坐标系1到坐标系3的旋转和坐标系2到坐标系4的旋转;若能确定坐标系3到坐标系5的旋转或坐标系4到坐标系5的旋转,则可获得三轴磁传感器的空间姿态(即磁传感器的三个坐标轴与已知坐标系坐标轴的指向关系)。
当磁场源1和磁场源2的磁感应强度最大值指向传感器时,若将传感器测得的磁感应强度方向分别旋转到X3或X4方向,则该矢量在Y3、Z3或Y4、Z4方向的分量将为0。即旋转传感器坐标系5,当测得的磁感应强度矢量在Y5、Z5方向的分量为0时,其X5轴的指向为X3或X4方向,可分别得到坐标系5到坐标系3的旋转和坐标系5到坐标系4的旋转。结合之前得到的坐标系1到坐标系3的旋转和坐标系2到坐标系4的旋转,可确定传感器的空间姿态。
坐标系1已知,用坐标系1到坐标系5的旋转矩阵R15就可以表示传感器的空间姿态,即
(6)
(7)
R35为磁场源1的磁感应强度最大值指向传感器时,磁感应强度最大值的当前姿态坐标系3与传感器坐标系5之间的旋转矩阵,R45为磁场源2的磁感应强度最大值指向传感器时,磁感应强度最大值的当前姿态坐标系4与传感器坐标系5之间的旋转矩阵,R13为磁场源1的坐标系1与传感器坐标系5之间的旋转矩阵,R14为磁场源2的坐标系2与传感器坐标系5之间的旋转矩阵。由于(,)和(,)已知,因此,R13、R14可以直接计算:
(8)
(9)
为求解矩阵R53或R54。将旋转矩阵R53表示成欧拉角的形式,即
(10)
式中,可推导ψ、θ、φ得:
(11)
(12)
(13)
式(13)中的参数为:
(14)
其中,、是A和B中的元素。
将推导出ψ、θ、φ角的公式代入式(10)中可以计算得到R53,再由公式(6)可以计算出传感器的姿态。
本发明具有不依赖磁场分布理论模型和非迭代的特点,并且通过电扫描方式实现旋转磁场跟踪能够有效提高系统的实时性和扫描的灵活性。本发明可靠性好、计算复杂度低,可应用于微创手术的导航,亦可运用于虚拟现实、三维超声成像等领域。
附图说明
图1为按照本发明的实施例的装置部分的视图。
图2为图1中的装置的细节框图。
图3为本发明的实施例的磁场源装置三视图。
图4为本发明的实施例的系统工作流程框图。
图5为本发明的实施例的系统搜索策略框图。
图6为本发明的实施例的待测物体位置算法示意图。
图7为本发明的实施例的待测物体姿态算法涉及的坐标系示意图。
图8为本发明的实施例的待测物体姿态算法流程图。
图中标号:1为电磁跟踪系统,2为三轴磁传感器装置,3为磁场源装置,4为控制处理显示装置,5为可控恒流源装置。6、7、8分别为三轴磁传感器装置的三轴分量传感器,9为信号调理和模数转换模块;10、11分别为两个磁场源装置磁场源1和磁场源2,12、13、14分别为磁场源装置10的三轴线圈,15、16、17分别为磁场源装置11的三轴线圈;18为控制单元,19为算法单元,20为显示输出单元,21为采样处理模块,22为激励电流控制模块;23为恒流源,24为控制电路;25为磁感应强度数据,26为旋转角数据;27为初始化过程模块,28为搜索过程模块,29为计算过程模块,30为位置计算过程模块,31为姿态计算过程模块,32为显示输出过程模块。
具体实施方式
下面结合具体实施例并参照附图,对系统组成及工作过程进行说明。本具体实施例所涉及的坐标系定义同表1,如图6所示;所涉及的经纬度角定义同发明内容。
本具体实施例设计了图1所示的电磁跟踪系统1,包括四个部分:三轴磁传感器装置2、磁场源装置3、控制处理显示装置4、可控恒流源装置5。传感器装置2附着于跟踪目标上。磁场源装置3包括两个磁场源10和11(对应发明内容和权利要求书中所述磁场源1和磁场源2),分别由三个缠绕在由软磁铁氧体材料做成的磁芯上的、中心点重合且相互正交的线圈组成;两个磁场源中心点之间的距离为d,且对应的线圈互相平行。控制处理显示装置4控制可控恒流源装置5以对磁场源10、11交替激励的方式,分别为磁场源装置3的各个线圈提供激励电流,按照一定的搜索策略改变各个线圈的激励电流强度,实现磁场源10、11产生的合成磁感应强度最大值指向的旋转。另外,控制处理显示装置还采集磁传感器装置2的输出,计算合成磁感应强度值以及磁传感器的空间位置和姿态,并输出或显示定位结果。
如图2所示为系统各部分的分解框图。
传感器装置2包括三轴分量传感器6、7、8,分别用来检测三个正交方向X5、Y5和Z5的磁感应强度。本实施例中的磁传感器选用三轴磁阻传感器。传感器的输出经后续的信号调理和模拟-数字(AD)转换模块9送入控制处理显示装置4。
磁场源装置3包括两个磁场源装置10和11,磁场源装置10由三个缠绕在截面为方形磁棒上的中心点重合且相互正交的线圈12、13和14组成;磁场源装置11由三个缠绕在截面为方形磁棒上的中心点重合且相互正交的线圈15、16和17组成。系统中,构成磁场源的磁棒长为10cm,正方形截面边长为1cm,每个线圈匝数均为100匝,三轴激励电流合成的模为1A。磁场源装置10和11的磁芯结构完全一样,其三视图如图3所示。
控制处理显示装置4由控制单元18、算法单元19、显示输出单元20组成。控制单元18包括采样处理模块21和激励电流控制模块22。控制处理显示装置4实现对其他组件的控制、数据的采集和处理、跟踪结果的显示输出等。
可控恒流源装置5由恒流源23和控制电路24组成。恒流源23由控制处理显示装置4的激励电流控制模块22控制。控制电路24将恒流源23输出的激励电流整形成脉冲,为磁场源装置3中的各个线圈提供激励电流,并且实现对构成两个磁场源装置10和11的两组线圈12、13、14和15、16、17的交替激励。
图4所示为系统的工作流程。开机后系统首先进行初始化。之后的工作过程可分为搜索过程28和计算过程29。其中搜索过程是控制处理显示装置4控制可控恒流源装置5对磁场源装置3提供适当的激励电流,通过磁场源10、11形成的两个合成磁感应强度最大值指向的旋转进行搜索。当磁场源装置中的磁场源10、11产生的合成磁感应强度最大值分别指向三轴磁传感器2后,系统即进入计算过程29。计算过程29包括位置计算过程30和姿态计算过程31,二者依次进行,分别计算传感器三自由度的位置和三自由度的姿态,其中姿态计算算法是依赖于位置计算结果的。每次计算完成时,执行显示输出过程32,实时更新跟踪结果。
图5所示是本实施例中采用的搜索策略的框图。搜索过程中,需保证磁场源10、11中的三轴线圈电流合成后的模不变。磁场源10三轴线圈的轴线方向分别为坐标系1的X1轴、Y1轴、Z1轴,各线圈的激励电流强度分别为、、,各线圈激励电流强度与合成磁感应强度最大值指向之间的关系由公式(1)确定;为了保证磁场源10产生的合成磁感应强度最大值指向遍历整个跟踪区域,可控制三个正交线圈的激励电流强度,使其先在一个面上搜索,如X1Y1平面;当传感器检测到最大磁感应强度值时,获得经度角;保持和之比不变(即保持经度角不变),通过改变再在X1Y1平面中经度角为的直线与Z1轴构成的平面上搜索,当传感器检测到最大磁感应强度值时,可获得纬度角,这样就获得了磁场源10产生的合成磁感应强度最大值指向在坐标系1中的一组经纬度角(,)。由于三轴正交线圈激励电流强度可以实现快速灵活的改变,针对不同的传感器位置,还可以尝试不同的搜索策略,例如先搜索X1Z1、Y1Z1或其他任意平面,得到最优的搜索策略。之后,磁场源11按照与磁场源10相同的搜索过程进行搜索。当磁场源11产生的合成磁感应强度最大值指向传感器时,可以得到另一组经纬度角(,);最后,结合两个磁场源10、11中心点之间的相对位置d,通过几何算法求解传感器的空间位置和姿态。搜索时,可通过控制线圈激励电流强度,使其总磁感应强度指向先向一个方向试探,若三轴磁传感器检测到的磁感应强度值增大,则表示试探方向正确,继续沿该方向搜索直至三轴磁传感器检测到的磁感应强度值减小,则前一旋转角所对应的方向即为最大磁感应强度方向。否则,反向搜索。
图7所示为位置算法的示意图。通过上述搜索可得到两组经纬度角(,)和(,),两磁场源之间的距离已知,则可通过式(3)~(5)计算传感器在坐标系1中的位置坐标(,,)。
图8所示为姿态算法流程图,通过公式(6)~(14)计算出三轴磁传感器坐标系5与系统坐标系1之间的旋转关系,即获得三轴磁传感器的姿态。
Claims (6)
1.一种基于电控旋转磁场的电磁跟踪系统,其特征在于:由一个三轴磁传感器装置、一个磁场源装置、一个可控恒流源装置和一个控制处理显示装置组成;其中:
所述三轴磁传感器装置附着于跟踪目标上,用于测量所在位置三个正交方向的磁感应强度;
所述磁场源装置包括相对位置和姿态已知的第一磁场源1和第二磁场源2,两个磁场源分别由三个缠绕在软磁铁氧体材料做成的磁芯上、中心点重合且相互正交的线圈组成;两个磁场源中心点之间的距离为d,且三组对应线圈相互平行;
所述可控恒流源装置为各线圈提供激励电流;分别改变三轴线圈激励电流强度,可控制第一磁场源1、第二磁场源2产生的合成磁感应强度最大值指向的改变;
所述控制处理显示装置通过控制可控恒流源装置输出的各路激励电流强度,使磁场源产生的合成磁感应强度最大值按照一定的搜索策略进行扫描,并最终指向三轴磁传感器装置;根据两个磁场源扫描并最终指向三轴磁传感器所获得的两组角度信息以及它们中心点之间的距离信息,由位置和姿态算法,计算传感器六自由度的位置和姿态;
磁场源装置和三轴磁传感器装置的空间位置及姿态,由如下定义的五个坐标系描述:
第一坐标系1:由第一磁场源1的初始位置和姿态定义的坐标系,组成第一磁场源1的三个线圈的轴线分别沿该坐标系的三个坐标轴,该坐标系也是系统坐标系,坐标系原点为(0,0,0);
第二坐标系2:由第二磁场源2的初始位置和姿态定义的坐标系,组成第二磁场源2的三个线圈的轴线分别沿该坐标系的三个坐标轴,第二坐标系2的原点在系统坐标系中的坐标为(d,0,0),各坐标轴与系统坐标系中的相应坐标轴平行;
第三坐标系 3:第一坐标系1的X轴旋转至第一磁场源1产生的磁感应强度最大值指向时所构成的坐标系;
第四坐标系4:第二坐标系2的X轴旋转至第二磁场源2产生的磁感应强度最大值指向时所构成的坐标系;
第五坐标系5:原点与三轴磁传感器的中心点重合,坐标轴方向分别与三轴磁传感器相应检测轴方向一致的坐标系;
Xn 、Yn 、Zn表示坐标系n的三个坐标轴;n=1,2,…,5;
描述三轴磁传感器装置空间位置和姿态以及磁场源产生的合成磁感应强度最大值指向的角度定义如下:
经度角:指从第一坐标系1的原点到三轴磁传感器中心点之间的连线在X1Y1平面的投影与X1轴之间的夹角;或者磁场源产生的合成磁感应强度最大值指向在X1Y1平面的投影与X1轴之间的夹角;
纬度角:指从第一坐标系1的原点到三轴磁传感器中心点之间的连线与该连线在X1Y1平面的投影之间的夹角;或者磁场源产生的合成磁感应强度最大值指向与该指向在X1Y1平面投影之间的夹角。
2.根据权利要求1所述的基于电控旋转磁场的电磁跟踪系统,其特征在于所述可控恒流源装置由恒流源、控制电路组成;恒流源输出的电流强度由控制处理显示装置控制;控制电路将恒流源输出的电流整形为脉冲形式,为磁场源装置的各线圈提供合适的激励电流,并且实现对构成第一磁场源1、第二磁场源2的两组线圈的交替激励。
3.根据权利要求1所述的基于电控旋转磁场的电磁跟踪系统,其特征在于所述控制处理显示装置,由控制单元、算法单元和显示输出单元组成;
控制单元包括两个部分:采样处理模块和激励电流控制模块;采样处理模块用于采样处理来自三轴磁场传感器装置的信号;激励电流控制模块控制可控恒流源装置对磁场源装置的各线圈提供合适强度的激励电流;
算法单元一方面根据采样处理模块的输出数据计算当前三轴磁场传感器装置检测到的磁感应强度值,进而根据搜索策略决定组成磁场源各线圈的激励电流强度;另一方面,当磁场源装置中的两个磁场源形成的合成磁感应强度最大值分别指向磁传感器时,计算磁传感器的空间位置坐标和空间姿态;
显示输出单元将磁传感器的定位信息显示/输出。
4.基于权利要求1-3之一所述电磁跟踪系统的电磁跟踪方法,其特征在于具体步骤为:
三轴磁传感器装置测量其所在位置的三个正交方向上的磁感应强度值,送至控制处理显示装置;
控制处理显示装置计算当前的合成磁感应强度值,并根据搜索策略控制可控恒流源装置输出适当强度的电流分别激励磁场源装置中第一磁场源1的三轴线圈,第一磁场源1的三轴线圈产生的磁感应强度最大值均沿各自轴向,并按照矢量合成的原理形成方向与各线圈激励电流强度相关的合成磁感应强度最大值;
改变三个线圈的激励电流强度,从而改变磁场源产生的合成磁感应强度最大值指向,对传感器进行搜索;当三轴磁传感器装置检测到最大磁感应强度时,表明由第一磁场源1产生的合成磁感应强度最大值指向磁传感器,根据此时磁场源装置的三轴线圈的激励电流强度,计算出此时磁感应强度最大值指向在第一坐标系1中的经纬度角;
磁场源装置中第二磁场源2通过与第一磁场源1相似的步骤搜索并最终指向磁传感器装置,即获得另外一组经纬度角;
根据所获得的两组经纬度角信息,结合磁场源装置中第一磁场源1和第二磁场源2中心点之间的距离d,即计算求得磁传感器装置的六自由度空间位置和空间姿态。
5.根据权利要求4所述的电磁跟踪方法,其特征在于在电控磁场旋转的过程中,需保证三轴电流合成后的模一致,为简化起见,假设模为1,则轴线为X轴、Y轴、Z轴的三个线圈的激励电流强度F1、F2、F3需满足下式:
若要求磁场源产生的合成磁感应强度最大值指向的经纬度角为,,则磁场源三轴线圈的激励电流强度可由下式计算:
磁场源通过控制合成磁感应强度最大值指向旋转并最终指向三轴磁传感器的搜索过程中,设三轴磁传感器在第一坐标系1中的位置用经纬度角(,)和距离R表示;以X1Y1平面作为第一磁场源1和第二磁场源2的初始搜索平面,此时磁场源合成的磁感应强度最大值方向的纬度角,则三个线圈的激励电流强度计算如下:
根据搜索范围,通过改变磁场源线圈激励电流F1、F2使磁场源合成磁感应强度最大值指向的经度角在或范围内变化,则三轴磁传感器装置检测到磁感应强度最大值时所对应的经度角对应于磁场源合成磁感应强度最大值指向三轴磁传感器在X1YI平面的投影,设为第一磁场源1对应的经度角,为第二磁场源2对应的经度角;
之后,保持经度角,不变,通过改变磁场源线圈激励电流F1、F2、F3使磁场源合成磁感应强度最大值指向的纬度角在范围内变化;则三轴磁传感器装置检测到磁感应强度最大值所对应的纬度角:设第一磁场源1对应的为,第二磁场源2对应的为,此时,对应于磁场源合成的磁感应强度最大值指向三轴磁传感器;这样得到两组旋转角(,)和(,),对应于第一磁场源1、第二磁场源2产生的合成磁感应强度最大值分别指向三轴磁传感器时的经纬度角;
此时,第一磁场源1三轴线圈激励电流强度为:
第二磁场源2三轴线圈激励电流强度为:
。
6.根据权利要求5所述的电磁跟踪方法,其特征在于关于空间位置算法如下:设三轴磁传感器在第一坐标系1中的位置坐标为(,,),其在X1Y1平面内的投影(,,0)到磁场源1和磁场源2的距离分别为、,则位置坐标(,,)计算如下:
。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310516908.3A CN103575271B (zh) | 2013-10-29 | 2013-10-29 | 基于电控旋转磁场的电磁跟踪系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310516908.3A CN103575271B (zh) | 2013-10-29 | 2013-10-29 | 基于电控旋转磁场的电磁跟踪系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103575271A CN103575271A (zh) | 2014-02-12 |
CN103575271B true CN103575271B (zh) | 2016-08-17 |
Family
ID=50047564
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310516908.3A Expired - Fee Related CN103575271B (zh) | 2013-10-29 | 2013-10-29 | 基于电控旋转磁场的电磁跟踪系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103575271B (zh) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016095168A1 (zh) * | 2014-12-18 | 2016-06-23 | 复旦大学 | 基于平板电脑的手术导航用的体数据可视化方法 |
CN104776865B (zh) * | 2015-03-21 | 2017-07-07 | 复旦大学 | 基于最大磁感应强度矢量旋转角快速测定的电磁跟踪系统及方法 |
CN105203096B (zh) * | 2015-10-10 | 2017-11-10 | 复旦大学 | 基于四点测量的旋转磁场快速跟踪方法及系统 |
CN108472090B (zh) * | 2015-12-29 | 2021-06-18 | 皇家飞利浦有限公司 | 用于控制外科手术机器人的系统、控制单元和方法 |
CN106950523B (zh) * | 2017-03-17 | 2020-08-28 | 复旦大学 | 基于压控恒流源的旋转磁场实现装置及方法 |
CN106951095A (zh) * | 2017-04-07 | 2017-07-14 | 胡轩阁 | 基于三维扫描技术的虚拟现实互动方法以及系统 |
CN107806879B (zh) * | 2017-11-29 | 2023-10-24 | 西安科技大学 | 一种煤矿矿井定位方法及定位系统 |
CN107830855B (zh) * | 2017-11-29 | 2024-03-15 | 西安科技大学 | 一种煤矿矿井导航定位系统 |
CN109099907B (zh) * | 2018-07-30 | 2023-06-23 | 广西大学 | 一种基于动态磁场分布的近距离无人机精确定位方法与引导系统 |
CN111060974B (zh) * | 2019-12-24 | 2022-02-11 | 重庆大学 | 一种用于水下铁磁性目标探测定位的磁力仪 |
CN114200360B (zh) * | 2021-11-10 | 2023-08-15 | 北京自动化控制设备研究所 | 三维线圈磁场均匀性测试方法及系统 |
CN114577100B (zh) * | 2022-02-21 | 2023-11-21 | 成都思瑞定生命科技有限公司 | 磁场目标定位计算方法 |
CN114779144B (zh) * | 2022-03-28 | 2023-02-14 | 北京微纳星空科技有限公司 | 一种测量三轴磁强计安装矩阵的方法、芯片和装置 |
CN114675226B (zh) * | 2022-03-28 | 2023-01-24 | 北京微纳星空科技有限公司 | 一种测量三轴磁强计安装矩阵的方法、系统、芯片和装置 |
CN116297147B (zh) * | 2023-05-15 | 2023-08-01 | 深圳大学 | 一种基于不同环境下的橡胶老化试验装置及其试验方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4054881A (en) * | 1976-04-26 | 1977-10-18 | The Austin Company | Remote object position locater |
US4849692A (en) * | 1986-10-09 | 1989-07-18 | Ascension Technology Corporation | Device for quantitatively measuring the relative position and orientation of two bodies in the presence of metals utilizing direct current magnetic fields |
CN101852868A (zh) * | 2010-05-20 | 2010-10-06 | 复旦大学 | 一种基于双磁棒旋转搜索的电磁跟踪方法及系统 |
-
2013
- 2013-10-29 CN CN201310516908.3A patent/CN103575271B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4054881A (en) * | 1976-04-26 | 1977-10-18 | The Austin Company | Remote object position locater |
US4849692A (en) * | 1986-10-09 | 1989-07-18 | Ascension Technology Corporation | Device for quantitatively measuring the relative position and orientation of two bodies in the presence of metals utilizing direct current magnetic fields |
CN101852868A (zh) * | 2010-05-20 | 2010-10-06 | 复旦大学 | 一种基于双磁棒旋转搜索的电磁跟踪方法及系统 |
Non-Patent Citations (3)
Title |
---|
Xin Ge etc..A Novel Non-model-based 6-DOF Electromagnetic Tracking Method Using Non-iterative Algorithm.《31st Annual International Conference of the IEEE EMBS》.2009, * |
Xin Ge etc..An Electromagnetic Tracking Method Using Rotating Orthogonal Coils.《IEEE TRANSACTIONS ON MAGNETICS》.2012,第48卷(第12期), * |
王法等.双磁棒旋转搜索电磁定位/跟踪的搜索策略研究.《中国医疗器械杂志》.2011,第35卷(第5期), * |
Also Published As
Publication number | Publication date |
---|---|
CN103575271A (zh) | 2014-02-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103575271B (zh) | 基于电控旋转磁场的电磁跟踪系统及方法 | |
CN103411624B (zh) | 基于微动平台的磁跟踪系统的磁场源标定方法及系统 | |
CN104776865B (zh) | 基于最大磁感应强度矢量旋转角快速测定的电磁跟踪系统及方法 | |
CN102426392B (zh) | 一种基于正交磁棒旋转搜索的电磁跟踪方法及系统 | |
CN106093843B (zh) | 一种基于地磁辅助WiFi的智能手机用户室内定位方法 | |
CN101852868B (zh) | 一种基于双磁棒旋转搜索的电磁跟踪方法及系统 | |
CN108662973B (zh) | 基于鉴相技术的电磁跟踪系统及方法 | |
CN111060974B (zh) | 一种用于水下铁磁性目标探测定位的磁力仪 | |
CN101248996A (zh) | 用于电磁跟踪方法和系统的线圈排列 | |
CN108844543A (zh) | 基于uwb定位及航位推算的室内agv导航控制方法 | |
CN102274024B (zh) | 基于微处理器的双磁棒旋转搜索定位跟踪系统 | |
CN109633491A (zh) | 全张量磁梯度测量系统安装误差的标定装置及标定方法 | |
CN103675739A (zh) | 具有旋转的编码梯度的磁共振相位对比血管造影术 | |
CN108021534A (zh) | 基于3-d磁场传感器的永磁球形电动机位置检测方法 | |
CN109143214A (zh) | 一种采用激光扫描的目标定位方法及装置 | |
CN105203096B (zh) | 基于四点测量的旋转磁场快速跟踪方法及系统 | |
CN110202577A (zh) | 一种实现障碍物检测的自主移动机器人及其方法 | |
JP2010243480A (ja) | 磁場測定装置 | |
CN108917751A (zh) | 一种免标定的定位方法及系统 | |
RU2011122702A (ru) | Способ определения параметров характеристики преобразования трехкомпонентного магнитометра | |
CN106556837A (zh) | 一种用于四元空间阵的超短基线定位方法 | |
CN105071737B (zh) | 基于三自由度球型电机的相对坐标变换算法及检测系统 | |
CN109612375A (zh) | 一种基于霍尔元件的球形电机转子位置检测方法 | |
CN115097370A (zh) | 一种大平面测磁系统中自平衡矢量磁力仪转向差校准方法 | |
KR20180079215A (ko) | 지자기 센서 기반 이동체의 위치 인식 시스템 및 방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160817 Termination date: 20201029 |