CN117717414A - 基于幅度解析的电磁定位系统及方法 - Google Patents
基于幅度解析的电磁定位系统及方法 Download PDFInfo
- Publication number
- CN117717414A CN117717414A CN202311575009.0A CN202311575009A CN117717414A CN 117717414 A CN117717414 A CN 117717414A CN 202311575009 A CN202311575009 A CN 202311575009A CN 117717414 A CN117717414 A CN 117717414A
- Authority
- CN
- China
- Prior art keywords
- amplitude
- magnetic
- signal
- frequency
- magnetic field
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000004458 analytical method Methods 0.000 title claims abstract description 20
- 230000006698 induction Effects 0.000 claims abstract description 40
- 230000005284 excitation Effects 0.000 claims abstract description 35
- 238000005070 sampling Methods 0.000 claims abstract description 23
- 230000003750 conditioning effect Effects 0.000 claims abstract description 10
- 238000005516 engineering process Methods 0.000 claims abstract description 8
- 238000006243 chemical reaction Methods 0.000 claims description 12
- 239000000203 mixture Substances 0.000 claims description 11
- 238000004364 calculation method Methods 0.000 claims description 5
- 230000036544 posture Effects 0.000 claims description 2
- 238000004519 manufacturing process Methods 0.000 claims 1
- 238000002324 minimally invasive surgery Methods 0.000 abstract description 3
- 238000003384 imaging method Methods 0.000 abstract description 2
- 238000005259 measurement Methods 0.000 abstract description 2
- 238000001514 detection method Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 8
- 238000001228 spectrum Methods 0.000 description 5
- 238000003491 array Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000005672 electromagnetic field Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 239000000696 magnetic material Substances 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Landscapes
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
Abstract
本发明属于电磁定位技术领域,具体为一种基于幅度解析的电磁定位系统及方法。本发明系统包括磁场源模块、磁传感器模块和控制模块;磁场源模块包含磁场源和交流恒流源,磁场源由两组相互正交的三轴线圈组成,交流恒流源为线圈提供激励电流;磁传感器模块包含三轴磁传感器和信号调理模块;控制模块包含激励控制电路、采样电路与微处理器;本发明按照一定规则对磁场源的线圈施加确定幅度、频率、相位的余弦信号,磁传感器模块输出磁感应强度信号至控制模块,控制模块利用幅度解析技术获取磁传感器检测信号中的特殊频率信号的幅度比,实现对目标的定位。本发明测量精度高、定位速度快、抗干扰能力强,可应用于微创手术导航、三维超声成像等领域。
Description
技术领域
本发明属于电磁跟踪技术领域,具体涉及一种基于幅度解析的电磁定位系统及方法。
背景技术
电磁跟踪是一种利用电磁场在空间分布信息对跟踪目标进行定位的方法,在计算机辅助的小型高精度微创手术导航系统,虚拟现实等领域具有非常广泛的应用,是目标跟踪领域的研究热点。和其他的跟踪方式相比,电磁跟踪具有无损伤、无辐射、无光路遮挡,操作简单方便的特点。但是,传统的电磁跟踪方法一般依赖于磁场源理论模型,存在迭代算法复杂、易受干扰等问题。
为解决上述问题,专利201110123757.6提出了一种基于“微处理器的双磁棒旋转搜索电磁定位系统”,这种方法不依赖于磁场源理论模型,采用简单的几何算法即可实现定位;但该方法的旋转磁场是通过步进电机控制螺旋管的旋转实现磁场的旋转,速度受步进电机带动螺线管旋转速度的限制,系统的实时性较差。为提高系统的定位速度,专利ZL201510123915.6提出了一种“基于最大磁感应强度矢量旋转角快速测定的电磁跟踪方法及系统”;通过测定最大磁感应强度矢量旋转角,实现对目标的定位。该方法提高了系统的定位速度,但极易受噪声干扰。为兼顾高精度、高速度,专利201810298617.4提出一种基于鉴相技术的电磁定位系统及方法,在保持系统定位精度的基础上改善抗干扰性能的电磁定位系统,但定位速度仍有提升空间。为进一步提高定位精度、定位速度,专利202310401074.5提出基于相位解析的电磁定位系统,在保持定位精度不变的情况下将定位时间缩短至1/3。
发明内容
本发明的目的在于提供一种既能提高定位精度和抗干扰能力,又能提定位速度的电磁定位系统及方法。
本发明是在专利202310401074.5的基础上,进一步提供一种用六种不同频率的交流恒流源同时激励系统的两个磁场源;获得三轴磁传感器(定位目标)检测到的磁感应强度矢量,分析提取位置信息,进一步提高电磁定位系统的定位速度和定位精度。
本发明提出的基于幅度解析技术的电磁定位系统,由如下三个部分组成:磁场源模块,磁传感器模块以及控制模块;其中:
所述磁场源模块,包含磁场源和交流恒流源;所述磁场源由两个相对位置和姿态已知、组成和结构完全相同的三轴正交线圈组成,两个三轴正交线圈记为S1和S2;所谓三轴正交线圈是由三个缠绕在磁芯上的、中心点重合且相互正交的线圈组成;线圈通电后即产生磁场;所述交流恒流源由恒流源及相关控制电路组成,为构成磁场源的线圈提供激励电流,即交流恒流源在控制模块的控制下按一定顺序输出一定频率的正余弦电流激励磁场源的各线圈;
所述磁传感器模块,包含一个三轴磁传感器以及相应的信号调理电路;所述三轴磁传感器附着于被定位目标,用于测量定位目标所处位置的三轴正交磁感应强度,将检测到的结果输入到信号调理电路中;信号调理电路对三轴磁传感器检测到的数据进行滤波和放大;
所述控制模块,包含激励控制电路、采样电路与A/D转换以及微处理器;所述激励控制电路在微处理器的控制下实现对磁场源各线圈激励电流的通断;所述采样电路与A/D转换电路对磁传感器输出的三路模拟信号采样并将其转换为数字信号,并输入到微处理器中进行处理;所述微处理器首先将采样得到的三路信号合成磁感应强度信号,并进行平方运算得到信号I;再对信号I进行幅度解析运算,得到特定频率位置的幅度值;再根据特定频率位置的幅度比,提取出位置信息,实现对目标点的跟踪定位。
定义本发明所述电磁定位系统的相关概念如下:
磁场源:S1由三个相互正交的线圈(S11、S12、S13)组成;S2由三个相互正交的线圈(S21、S22、S23)组成;
坐标系:坐标系1为全局坐标系,其三个坐标轴X1、Y1、Z1分别与组成S1的三个相互正交的线圈(S11、S12、S13)的轴线重合,坐标系原点(0,0,0),对应于组成S1的三个线圈重合的中心点;坐标系2的三个坐标轴X2、Y2、Z2分别与组成S2的三个相互正交的线圈(S21、S22、S23)的轴线重合,组成S2的三个线圈重合的中心点位于坐标系2的原点,坐标系2的原点位于为全局坐标系的(d,0,0)点,即两个磁场源装置中心点之间的距离为d;此外,X1、X2相互平行但方向相反;Y1与Y2、Z1与Z2相互平行且方向相同。
待测目标的位置表示:待测目标P在坐标系1中的坐标表示为(x1,y,z),在坐标系2中的坐标表示为(x2,y,z),其中x1和x2之和为的d。
为实现对磁传感器的定位,通过以下幅度解析技术获取两组磁传感器检测到的特定频率信号的幅度比值,据此计算出磁传感器位置坐标。
对线圈S11、S12和S13分别施加幅度为A、相位为0、角频率为w11、w12和w13的余弦激励信号Acos w11t、Acosw12t和Acosw13t;再用幅度为A,相位为0、角频率分别为w21、w22和w23的余弦信号Acosw21t、Acosw22t和Acosw23t激励线圈S21、S22和S23。
此时,S1在磁传感器处所形成的合成磁感应强度记为B1,B1在磁传感器三个正交轴的分量依次记为B1x,B1y,B1z;S2在磁传感器处所形成的合成磁感应强度记为B2,B2在此磁传感器三个正交轴的分量记为B2x,B2y,B2z;两个磁场源在三轴磁传感器处产生的总磁感应强度记为B,B为B1、B2的矢量和。
磁传感器在坐标系1的坐标为(x1、y、z),其与坐标系1原点之间的距离为r1,有r1 2=x1 2+y2+z2;利用磁偶极子公式求解磁传感器各轴检测到的S1产生的磁感应强度如式(1):
其中,k1为常系数;
于是,对S1所形成的合成磁感应强度B1进行平方运算得到的信号1如式(2):
当磁传感器空间位置确定时,M1为常量;
由式(2)知:此时传感器检测到的合成磁感应强度B1的平方包含角频率为w11+w12、w11-w12、w11+w13、w11-w13、w12+w13和w12-w13的余弦信号;本发明选取角频率为w11+w12、w11+w13和w12+w13的余弦信号,提取这三个特定频率信号的幅值3x1y、3x1z和3yz,并由式(3)计算出所选频率信号的两个幅度比R11、R12。
磁传感器在坐标系2的坐标为(x2、y、z),其与坐标系2原点之间的距离为r2,有r2 2=x2 2+y2+z2;利用磁偶极子公式求解磁传感器各轴检测到的S2产生的磁感应强度如式(4):
其中,k2为常系数。
于是,对S2所形成的合成磁感应强度B2进行平方运算得到的信号2,如式(5):
当磁传感器空间位置确定时,M2为常量。
由式(5)知:此时传感器检测到的合成磁感应强度B2的平方,其包含角频率为w21+w22、w21-w22、w21+w23、w21-w23、w22+w23和w22-w23的余弦信号;本发明选取角频率为w21+w22、w21+w23和w22+w23的余弦信号,提取这三个特定频率信号的幅值3x2y、3x2z和3yz,并由式(6)计算出所选频率信号的两个幅度比R21、R22:
R21=3x2z/3yz=x2/y,R22=3x2y/3yz=x2/z; (6)
已知待测目标相对于S1和S2的两组幅度比(R11、R12)、(R21、R22)、以及两磁场源中心点之间的距离d,待测目标在系统坐标系中的位置坐标算式(x、y、z)可由式(7)计算(其中x=x1):
从三轴磁传感器检测到的合成磁感应强度的平方(信号I)中提取两组幅度比(R11、R12)、(R21、R22),具体如下:
采用数字或模拟的方式获取信号1的复频域信息:对信号I进行FFT运算,将信号I解析成是由不同频率、幅值,相位的余弦波。选取合适的频率,保证其频率独立且不与其他频率混叠避免不必要的干扰然后提取其幅值:假设采样频率为Fs,采样点数为N,FFT后,某一点n(n从1开始)表示的频率为:Fn=(n-1)Fs/N,该频率在复频域所对应的模为Yn,则该频率信号在时域的幅值为2Yn/N。即为该频率信号的幅值。
综上,本发明基于幅度解析的电磁定位方法,具体操作流程如下:
(1)对线圈S11、S12和S13分别施加幅度为A、相位为0、角频率为w11、w12和w13的余弦激励信号Acos w11t、Acos w12t和Acos w13t;再用幅度为A,相位为0、角频率分别为w21、w22和w23的余弦信号Acos w21t、Acos w22t和Acos w23t激励线圈S21、S22和S23;
(2)对三轴磁传感器模块的三路模拟输出进行严格同步的采样后输入控制模块;
(3)控制模块计算出磁传感器检测到的S1和S2在磁传感器处产生的合成磁感应强度的平方记为信号I;
(4)对信号I进行FFT运算,提取出信号I中角频率为w11+w12、w11+w13、w12+w13、w21+w22、w21+w23和w22+w23的六个余弦信号的幅值:假设采样频率为Fs,采样点数为N,FFT后,某一点n(n从1开始)表示的频率为:Fn=(n-1)Fs/N,该频率在复频域所对应的模为Yn,则该频率信号在时域的幅值为2Yn/N,即为该频率信号的幅值;
(5)利用幅度比关系式(3)、(6),以及两磁场源中心点之间的距离d,根据公式(7)计算求得磁场传感器装置的空间位置坐标。
本发明所提出的基于幅度解析技术确定定位目标的方法,其激励信号为幅值恒定、频率恒定、相位为0的余弦信号。系统通过解析磁传感器检测到的合成磁感应强度平方信号的复频域信息,提取特定信号的幅度,根据公式(3)、(6)计算幅度比,继而根据公式(7)实现对目标的定位。
采用本发明提出的幅度解析技术同时用6个不同频率的交流恒流源激励S1、S2获得特定频率成分的幅度比;进而计算三轴磁传感器(目标点)的坐标位置,经过1次激励即可获得定位所需的所有信息。本发明测量精度高、定位速度快、抗干扰能力强,可应用于计算机辅助的小型高精度微创手术的导航,三维超声成像等领域。与专利202310401074.5所述技术相比,在相同激励信号频率的条件下,定位速度提高1倍,定位精度提升1/3,系统复杂度进一步降低。
附图说明
图1为本发明电磁定位系统的结构框图。
图2为本发明电磁定位系统的结构细节图。
图3为系统所涉及的各个线圈的位置和编号示意图。
图4为系统所涉及的全局坐标系示意图。
图5为系统的工作流程图。
图6为本发明具体实施例中幅度解析算法示意图。
图中标号:1为磁场源模块,2为磁传感器模块,3为控制模块。4为磁场源的激励信号,5、6、7为S1对应的三轴正交线圈,8、9、10为S2对应的三轴正交线圈;11为磁传感器,12为信号调理模块;13为AD转换与采样电路,14为处理器的控制单元,15为激励控制电路,16为处理器的存储单元,17为处理器的幅度解析单元,18为处理器的坐标计算单元。
具体实施方式
下面结合具体实施例并参照附图,对系统组成以及工作过程进行详细说明。下文所涉及的坐标系定义、角度定义以及线圈编号均同发明内容。但是,本发明的保护范围并不仅仅局限于此实例,熟悉该领域的技术人员根据发明的技术内容,通过简单的更换和代替所作出的其他实例,都应该属于本发明的保护范围。本发明所保护的范围以权利要求书的为准。
图1为本发明的系统结构组成示意图,包括两个部分:磁场源模块1、磁传感器模块2以及控制模块3。
图2为本发明的系统功能模块图。
从图2可以看出,磁场源模块包括由三轴线圈5、6、7组成的S1,8、9、10组成的S2以及交流恒流激励电源4,磁场源是由缠绕在软磁铁材料上的三轴正交线圈组成,线圈的中心点相互重合。交流恒流激励电源4在控制模块的控制下为线圈提供特定频率的激励信号,本实施例中交流恒流激励电源4可以同时输出6路频率固定、相位固定的恒流激励信号,可实现对指定线圈的交替激励。输出信号频率可以在一定范围设定并且有较高的稳定性。
磁传感器模块2包括三轴磁传感器11和信号调理模块12。磁传感器11可检测所在位置三个正交方向的磁感应强度。传感器检测到的磁感应强度通过信号调理模块12进行放大滤波,从而方便后续的采样及转换。
控制模块3包括激励控制电路15、采样电路以及A/D转换13、控制单元14、存储单元16、幅值解析单元17以及坐标计算单元18。激励控制电路15在控制单元14的控制下实现对各线圈激励电流的通断;A/D转换电路13含三路模拟信号接口用于接入磁传感器模块输出的三路模拟信号1、2、3,经A/D转换后变成三路数字信号输入到处理器的存储单元16中进行存储;幅值解析单元求取信号1、2、3的矢量和得到合成磁感应强度,进而根据公式(2)或(5)计算出合成磁感应强度平方的信号在特殊频率的幅值;坐标计算单元18根据公式(3)或(6)计算特定频率的幅度比,最后根据公式(7)算出传感器所在位置的坐标。
图3为系统所涉及的各个线圈的位置和编号示意图。线圈S11、线圈S12、线圈S13分别代表坐标系1中与X1、Y1、Z1轴相对应的三个线圈。线圈S21、线圈S22、线圈S23分别代表坐标系2中与X2、Y2、Z2轴相对应的三个线圈。不同频率的余弦信号同时激励线圈S11、线圈S12,线圈S13、线圈S21、线圈S22、线圈S23,利用幅度解析法求解合成磁感应强度的平方特殊频率的幅值求解出两组幅度比(R11、R12)、(R21、R22)。
图4为全系统坐标示意图。坐标系1的原点位于(0,0,0),与S1三个线圈的中心点重合。坐标系2的原点位于(d,0,0),与S2三个线圈的中心点重合。即两个磁场源装置中心点之间的距离为d。X1、X2相互平行但方向相反;Y1与Y2、Z1与Z2相互平行、方向相同。
图5为系统的工作流程图,具体步骤如下:
(1)首先是系统的初始化,包括将控制模块的两路数模转换内核配置成同步模式;配置微处理器工作模式,数据传递模式设置成从外设到内存,同时设置好内存首地址;配置系统定时器,实现对采样频率的精准控制;具体实施S1的激励电流频率为w11=1kHz、w12=1.5kHz和w13=2kHz,S2的激励电流频率为w21=1.5kHz、w22=3kHz、和w23=3.5kHz,合成磁感应强度B2包含的频率13个,其中无其他频率信号干扰的特殊信号(此频率上仅有一个确定幅值的信号)分别为2.5kHz、3.5kHz、1kHz、1.5kHz、6.5kHz、5kHz,其幅值分别为:3x1y、3yz、3x1z、3x2y、3yz、3x2z;为避免频谱混叠,本发明将采样频率设置成32kHz;
(2)恒流交流电源对线圈S11施加幅度为1A、相位为0、角频率为1kHz的余弦激励信号,对线圈S12施加同幅同相、角频率为1.5kHz的余弦激励信号,对线圈S13施加同幅同相、角频率为2kHz的余弦激励信号;再用幅度为1A,相位为0、角频率为1.5kHz的余弦信号激励线圈S21,对线圈S22施加同幅同相、角频率为3kHz的余弦激励信号,对线圈S23施加同幅同相、角频率为3.5kHz的余弦激励信号;
(3)AD转换及采样模块采集磁传感器模块输出的三路正交磁感应强度模拟信号,转换成数字信号后输入到处理器中,利用幅度解析获取幅度比(R11、R12)、(R21、R22)并存储;
(4)将步骤(3)中得到的幅度比,带入公式(7),求出待测目标的位置,实现对目标的定位。
图6为本发明具体实施例中幅度解析算法示意图。具体实施步骤如下:
(1)AD转换后得到三路数字信号,经微处理器传送到处理器的存储空间中;处理器对磁传感器模块输出的三路三轴正交磁感应强度求取平方和得到信号1;
(2)对步骤(1)中得到的信号1进行快速傅里叶变换,将信号1解析成是由不同频率、幅值、相位的正弦波组成的信号;在内存中开辟两个2048点的浮点格式的数组,用于存储快速傅里叶变换得到的信号频谱,以奇数地址存储实数部分,以偶数地址存储虚数部分;
(3)选取合适的频率,保证其频率独立且不与其他频率混叠避免不必要的干扰然后提取其幅值:采样频率为32kHz,采样点数为N=1024点,即频率分辨率为32kHz/1024=31.25Hz;无其他频率信号干扰的特殊信号分别为2.5kHz、3.5kHz、1kHz、1.5kHz、6.5kHz、5kHz,又因2.5kHz/31.25Hz=80、3.5kHz/31.25Hz=112、1kHz/31.25Hz=32、1.5kHz/31.25Hz=48、6.5kHz/31.25Hz=208、5kHz/31.25Hz=160、可知信号1中对应数字频谱的谱点数分别为81、113、33、49、209、161;取出该点对应的实部和虚部,求其模值Yn(n为上述的谱点数)利用公式2Yn/N,带入Yn、N求取幅值并存储。
Claims (5)
1.一种基于幅度解析的电磁定位系统,其特征在于,由如下三个部分组成:磁场源模块,磁传感器模块以及主控模块,其中:
所述磁场源模块,包含磁场源和交流恒流源;所述磁场源由两组相对位置和姿态已知、组成和结构完全相同的三轴正交线圈组成,记为磁场源S1和磁场源S2;所谓三轴正交线圈是由三个缠绕在磁芯上的、中心点重合且相互正交的线圈组成,线圈通电后即产生磁场;所述交流恒流源由恒流源及相关控制电路组成,为构成磁场源的线圈提供激励电流,即交流恒流源在控制模块的控制下输出激励磁场源线圈的余弦电流;
所述磁传感器模块,包含一个三轴磁传感器以及相应的信号调理电路;所述三轴磁传感器附着于被跟踪目标,测量跟踪目标所处位置的三个正交方向的磁感应强度,将检测到的结果输入到信号调理电路中;信号调理电路对三轴磁传感器检测到的信号进行滤波和放大;
所述控制模块,包含激励控制电路、采样电路与A/D转换以及微处理器;所述激励控制电路在微处理器的控制下实现对磁场源各线圈激励电流的通断;所述采样电路与A/D转换电路对磁传感器输出的三路模拟信号(对应于三个正交方向的磁感应强度)采样并将其转换为数字信号输入到微处理器中进行处理;所述微处理器首先将采样得到的三路信号合成总磁感应强度信号,并进行平方运算得到信号I;再对信号I进行幅度解析运算,得到特定频率信号的幅度值;根据信号I中特定频率信号的幅度比,提取出位置信息,实现对目标点的跟踪定位;
其中,相关概念定义如下:
磁场源S1由三个相互正交的线圈S11、S12、S13组成;磁场源S2由三个相互正交的线圈S21、S22、S23组成;
坐标系1为全局坐标系,其三个坐标轴X1、Y1、Z1分别与组成S1的三个相互正交的线圈S11、S12、S13的轴线重合,坐标系原点(0,0,0)对应于组成磁场源S1的三个线圈重合的中心点;坐标系2,其三个坐标轴X2、Y2、Z2分别与组成S2的三个相互正交的线圈S21、S22、S23的轴线重合,组成S2的三个线圈重合的中心点位于坐标系2的原点,坐标系2的原点位于为全局坐标系的(d,0,0)点,即两个磁场源装置中心点之间的距离为d;此外,X1、X2相互平行但方向相反;Y1与Y2、Z1与Z2相互平行且方向相同;
待测目标的位置表示:待测目标P在坐标系1中的坐标表示为(x1,y,z),在坐标系2中的坐标表示为(x2,y,z),其中x1和x2之和为的d。
2.基于权利要求1所述电磁定位系统的电磁定位方法,其特征在于,通过以下幅度解析技术获取两组磁传感器检测到的特定频率信号的幅度比值,据此计算出磁传感器位置坐标;具体步骤为:
(一)对线圈S11、S12和S13分别施加幅度为A、相位为0、角频率为w11、w12和w13的余弦激励信号Acosw11t、Acosw12t和Acosw13t;再用幅度为A,相位为0、角频率分别为w21、w22和w23的余弦信号Acosw21t、Acosw22t和Acosw23t激励线圈S21、S22和S23;
此时S1在磁传感器处所形成的合成磁感应强度记为B1,B1在磁传感器三个正交轴的分量依次记为B1x,B1y,B1z;S2在磁传感器处所形成的合成磁感应强度记为B2,B2在此磁传感器三个正交轴的分量记为B2x,B2y,B2z;两个磁场源在三轴磁传感器处产生的总磁感应强度记为B,B为B1、B2的矢量和;
磁传感器在坐标系1的坐标为(x1、y、z),其与坐标系1原点之间的距离为r1,有r1 2=x1 2+y2+z2;利用磁偶极子公式求解磁传感器各轴检测到的S1产生的磁感应强度如式(1):
其中,k1为常系数;
于是,对S1所形成的合成磁感应强度B1进行平方运算得到的信号1如式(2):
当磁传感器空间位置确定时,M1为常量;
由(2)式知:此时传感器检测到的合成磁感应强度B1的平方包含角频率为w11+w12、w11-w12、w11+w13、w11-w13、w12+w13和w12-w13的余弦信号;选取角频率为w11+w12、w11+w13和w12+w13的余弦信号,提取这三个特定频率信号的幅值3x1y、3x1z和3yz,并由式(3)计算出所选频率信号的两个幅度比R11、R12:
(二)磁传感器在坐标系2的坐标为(x2、y、z),其与坐标系2原点之间的距离为r2,有r2 2=x2 2+y2+z2;利用磁偶极子公式求解磁传感器各轴检测到的S2产生的磁感应强度如式(4):
其中,k2为常系数;
于是,对S2所形成的合成磁感应强度B2进行平方运算得到的信号2,如式(5):
当磁传感器空间位置确定时,M2为常量;
由(5)式知:此时传感器检测到的合成磁感应强度B2的平方,其包含角频率为w21+w22、w21-w22、w21+w23、w21-w23、w22+w23和w22-w23的余弦信号;选取角频率为w21+w22、w21+w23和w22+w23的余弦信号,提取这三个特定频率信号的幅值3x2y、3x2z和3yz,并由式(6)计算出所选频率信号的两个幅度比R21、R22:
R21=3x2z/3yz=x2/y,R22=3x2y/3yz=x2/z, (6)。
3.根据权利要求2所述的电磁定位方法,其特征在于,根据式(3)、式(6)计算得到的两组幅度比(R11、R12)、(R21、R22)、以及两磁场源中心点之间的距离d,待测目标在系统坐标系中的位置坐标算式(x、y、z)由(7)计算(其中x=x1):
4.根据权利要求3所述的电磁定位方法,其特征在于,从三轴磁传感器检测到的合成磁感应强度的平方(信号I)中提取两组幅度比(R11、R12)、(R21、R22),具体如下:
采用数字或模拟的方式获取信号1的复频域信息:对信号I进行FFT运算,将信号I解析成是由不同频率、幅值,相位的余弦波;选取合适的频率,保证其频率独立且不与其他频率混叠:假设采样频率为Fs,采样点数为N,FFT后,某一点n(n从1开始)表示的频率为:该频率在复频域所对应的模为Yn,则该频率信号在时域的幅值为2Yn/N;即为该频率信号的幅值。
5.根据权利要求2所述的电磁定位方法,其特征在于,具体操作流程如下:
(1)对线圈S11、S12和S13分别施加幅度为A、相位为0、角频率为w11、w12和w13的余弦激励信号Acosw11t、Acosw12t和Acosw13t;再用幅度为A,相位为0、角频率分别为w21、w22和w23的余弦信号Acosw21t、Acosw22t和Acosw23t激励线圈S21、S22和S23;
(2)对三轴磁传感器模块的三路模拟输出进行严格同步的采样后输入控制模块;
(3)控制模块计算出磁传感器检测到的S1和S2在磁传感器处产生的合成磁感应强度的平方记为信号I;
(4)对信号I进行FFT运算,提取出信号I中角频率为w11+w12、w11+w13、w12+w13、w21+w22、w21+w23和w22+w23的六个余弦信号的幅值:假设采样频率为Fs,采样点数为N,FFT后,某一点n(n从1开始)表示的频率为:Fn=(n-1)Fs/N,该频率在复频域所对应的模为Yn,则该频率信号在时域的幅值为2Yn/N,即为该频率信号的幅值;
(5)利用幅度比关系式(3)、(6),以及两磁场源中心点之间的距离d,根据公式(7)计算求得磁场传感器装置的空间位置坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311575009.0A CN117717414A (zh) | 2023-11-23 | 2023-11-23 | 基于幅度解析的电磁定位系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311575009.0A CN117717414A (zh) | 2023-11-23 | 2023-11-23 | 基于幅度解析的电磁定位系统及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN117717414A true CN117717414A (zh) | 2024-03-19 |
Family
ID=90204262
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311575009.0A Pending CN117717414A (zh) | 2023-11-23 | 2023-11-23 | 基于幅度解析的电磁定位系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117717414A (zh) |
-
2023
- 2023-11-23 CN CN202311575009.0A patent/CN117717414A/zh active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108662973B (zh) | 基于鉴相技术的电磁跟踪系统及方法 | |
CN103300862B (zh) | 一种胶囊内窥镜病灶组织深度和三维尺寸的测量方法 | |
Song et al. | An efficient magnetic tracking method using uniaxial sensing coil | |
CN102426392B (zh) | 一种基于正交磁棒旋转搜索的电磁跟踪方法及系统 | |
Hu et al. | A novel positioning and orientation system based on three-axis magnetic coils | |
CN104776865B (zh) | 基于最大磁感应强度矢量旋转角快速测定的电磁跟踪系统及方法 | |
CN103575271B (zh) | 基于电控旋转磁场的电磁跟踪系统及方法 | |
CN104655714B (zh) | 基于宽频磁波反射通路参数辨识的检测与成像方法及装置 | |
JPH11510406A (ja) | カテーテルプローブを操縦するための方法及びシステム | |
CN102022975A (zh) | 一种角位移传感器系统误差自标定方法 | |
CN103675718B (zh) | 采用余弦函数曲线拟合确定磁感应强度最大值的方法及实现系统 | |
JP2017505916A (ja) | 単一コイル磁場誘導トモグラフィー撮像 | |
CN101852868B (zh) | 一种基于双磁棒旋转搜索的电磁跟踪方法及系统 | |
WO2015128705A1 (en) | Coil for magnetic induction tomography imaging | |
CN103499810A (zh) | 一种用于电磁定位的装置和方法 | |
CN102274024A (zh) | 基于微处理器的双磁棒旋转搜索定位跟踪系统 | |
JP2003279611A (ja) | 電磁波発生源探査装置 | |
CN117717414A (zh) | 基于幅度解析的电磁定位系统及方法 | |
CN105203096B (zh) | 基于四点测量的旋转磁场快速跟踪方法及系统 | |
Klein et al. | Optimized spherical sound source for auralization with arbitrary source directivity | |
JPWO2005051203A1 (ja) | ドプラ速度検出装置及びそれを用いた超音波診断装置 | |
CN117367265A (zh) | 基于相位解析的电磁定位系统及方法 | |
Li et al. | A new calibration method for magnetic sensor array for tracking capsule endoscope | |
Pospisil et al. | 4-D x 3-D ultrasound: real-time scan conversion, filtering, and display of displacement vectors with a motorized curvilinear transducer | |
Mohamed et al. | Subpixel accuracy analysis of phase correlation shift measurement methods applied to satellite imagery |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |