CN104361608B - 一种工业用柔性导管内窥镜的定位跟踪方法 - Google Patents
一种工业用柔性导管内窥镜的定位跟踪方法 Download PDFInfo
- Publication number
- CN104361608B CN104361608B CN201410581509.XA CN201410581509A CN104361608B CN 104361608 B CN104361608 B CN 104361608B CN 201410581509 A CN201410581509 A CN 201410581509A CN 104361608 B CN104361608 B CN 104361608B
- Authority
- CN
- China
- Prior art keywords
- coil
- axis
- axial
- receiving coil
- parallel
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V3/00—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation
- G01V3/08—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation operating with magnetic or electric fields produced or modified by objects or geological structures or by detecting devices
- G01V3/10—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation operating with magnetic or electric fields produced or modified by objects or geological structures or by detecting devices using induction coils
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/20—Analysis of motion
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30172—Centreline of tubular or elongated structure
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Remote Sensing (AREA)
- Life Sciences & Earth Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Geology (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geophysics (AREA)
- Multimedia (AREA)
- Environmental & Geological Engineering (AREA)
- Electromagnetism (AREA)
- Endoscopes (AREA)
Abstract
本发明公开了一种工业用柔性导管内窥镜的定位跟踪方法,其首先在当前工作的发射线圈中的三轴线圈上各加载激励信号,使在其周围产生交变电磁场,每个接收线圈在感应到交变电磁场后产生交变电信号;然后对每个接收线圈产生的交变电信号进行处理,得到对应的无噪声数据;再根据无噪声数据的幅值,确定每个接收线圈在被测物内的位置和方向,实现柔性导管内窥镜的定位;最后根据每个接收线圈在被测物体内的位置和方向,得到柔性导管内窥镜的导管的运动变化以及镜头的行进轨迹,实现柔性导管内窥镜的跟踪;优点是能够跟踪检查柔性导管内窥镜的镜头的行进轨迹和导管的运动变化,且能够快速准确地确定柔性导管内窥镜的目标位置,此外对操作者无辐射。
Description
技术领域
本发明涉及一种工业用内窥镜技术,尤其是涉及一种工业用柔性导管内窥镜的定位跟踪方法。
背景技术
从内窥镜的发展及成像构造上分为硬管式内窥镜和软管式内窥镜。软管式内窥镜即柔性导管内窥镜是一个配备有灯光的管子,可以利用其检测硬管式内窥镜无法检测的地方,因此其在工业以及医学上得到了广泛的使用。在工业上,根据无损检测和孔探技术的特殊要求,一方面,柔性导管内窥镜可用于高温、有毒、核辐射及人眼无法直接观察到的场所的检查和观察,主要用于安防、安检方面,以及汽车、航空发动机、管道、机械零件的检修等,可在不需拆卸或破坏组装及设备停止运行的情况下实现无损检测;另一方面,柔性导管内窥镜还可与照相机、摄像机或电子计算机连接,组成照相、摄像和图像处理***,从而进行现场目标的监视、记录、贮存和图像分析。在医学上,可以利用柔性导管内窥镜检测器官的病变情况。
柔性导管内窥镜使用时,由于其自身具有较柔软、不易控制的特点,因此会给操作者控制柔性导管内窥镜快捷、顺利、平滑自如地到达观测点造成不便。为此,在使用柔性导管内窥镜进行检测时,需要对柔性导管内窥镜在观测物中的位置进行定位与跟踪,操作者根据定位得到的内窥镜的形态信息,通过其操作装置控制和调节柔性导管内窥镜的前端镜头和导管的运动方向,使柔性导管内窥镜以合理的方式前进或伸缩以便到达观测点。
目前,对于柔性导管内窥镜的定位跟踪,较为普遍的做法是X光影像提供柔性导管内窥镜的位置形态,即在检测时,利用X光投射内窥镜检测的相应部位,X光透视成像设备接收图像,并将其显示在屏幕上供操作者参考。显然,这种方法需要持续间隔地进行X光照射,一方面,存在严重的X光射线损害问题,而为了减低X光射线对工作人员的危害,通常要求工作人员背上笨重的X光射线隔离(铅板)装置,然而该装置体积大,对工作人员的行动会造成严重的不便;另一方面,如果限制X光照射次数,则会使观测的连续性、实时性受到限制;其次,X光透视成像设备只能产生二维投影图像,缺乏深度信息,因此工作人员很难在二维投影图像下快速确定目标位置。
发明内容
本发明所要解决的技术问题是提供一种无辐射的工业用柔性导管内窥镜的定位跟踪方法,其能够跟踪检查柔性导管内窥镜的镜头的行进轨迹和导管的运动变化,且能够快速准确地确定柔性导管内窥镜的形态信息和目标位置。
本发明解决上述技术问题所采用的技术方案为:一种工业用柔性导管内窥镜的定位跟踪方法,其特征在于包括以下步骤:
①在被测物体所在空间内的不同位置处各布置一个三轴正交的电磁线圈,并将这些电磁线圈均作为发射线圈;在柔性导管内窥镜的导管的外管壁上的不同位置处及在柔性导管内窥镜的镜头上各布置一个三轴正交的电磁线圈,并将这些电磁线圈均作为接收线圈,接收线圈中的三轴线圈的工作电流一致,且半径一致;再将柔性导管内窥镜置于被测物体内;
②当前工作的发射线圈为第i个发射线圈,则在第i个发射线圈中的三轴线圈上各加载正弦波交变电信号作为激励信号,使第i个发射线圈在其周围产生交变电磁场,此时每个接收线圈在感应到交变电磁场后产生交变电信号,其中,1≤i≤I',I'表示在被测物体所在空间内布置的发射线圈的总个数;
③对每个接收线圈产生的交变电信号依次进行信号放大处理、信号滤波处理、模数转换处理及数据后处理,得到每个接收线圈产生的交变电信号对应的无噪声数据,并获取无噪声数据的幅值;
④根据无噪声数据的幅值,确定每个接收线圈在被测物体内的位置和方向,实现柔性导管内窥镜的定位,具体过程为:
④-1、根据法拉第电磁感应定律,利用无噪声数据的幅值代表的电压值,计算得到每个接收线圈中的三轴线圈各自的磁感应强度;
④-2、根据每个接收线圈中的三轴线圈各自的磁感应强度,确定每个接收线圈在空间直角坐标系中的位置即确定每个接收线圈在被测物体内的位置,将第j个接收线圈在空间直角坐标系中的位置记为P,P=(x,y,z), 其中,1≤j≤J,J表示在柔性导管内窥镜的导管的外管壁上的不同位置处及在柔性导管内窥镜的镜头上布置的接收线圈的总个数,空间直角坐标系的原点在被测物体所在空间的地面,B1'表示第i个发射线圈中的与X轴平行的一轴线圈工作时第j个接收线圈中的三轴线圈的磁感应强度之和,B2'表示第i个发射线圈中的与Y轴平行的一轴线圈工作时第j个接收线圈中的三轴线圈的磁感应强度之和,B3'表示第i个发射线圈中的与Z轴平行的一轴线圈工作时第j个接收线圈中的三轴线圈的磁感应强度之和,BT为常量,BT=μ0IR2/4,μ0为真空磁导率,I为第j个接收线圈中的线圈的工作电流,R为第j个接收线圈中的线圈的半径,(B')2=(B1')2+(B2')2+(B3')2;
④-3、根据每个接收线圈中的三轴线圈各自的磁感应强度,确定每个接收线圈在空间直角坐标系中的方向即确定每个接收线圈在被测物体内的方向,将第j个接收线圈在空间直角坐标系中的各个方向组成的向量记为Η,Η=(α,β,γ),其中,1≤j≤J,J表示在柔性导管内窥镜的导管的外管壁上的不同位置处及在柔性导管内窥镜的镜头上布置的接收线圈的总个数,空间直角坐标系的原点在被测物体所在空间的地面,α表示第j个接收线圈与空间直角坐标系的X轴的夹角,β表示第j个接收线圈与空间直角坐标系的Y轴的夹角,γ表示第j个接收线圈与空间直角坐标系的Z轴的夹角, R表示由(α,β,γ)确定的旋转矩阵,这里,Rot(x,α)表示相对于空间直角坐标系的X轴的旋转矩阵,Rot(y,β)表示相对于空间直角坐标系的Y轴的旋转矩阵,Rot(z,γ)表示相对于空间直角坐标系的Z轴的旋转矩阵,为的逆矩阵,Bx1,By1,Bz1对应表示第i个发射线圈中与X轴平行的一轴线圈工作时第j个接收线圈中的与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈感应到的磁感应强度,Bx2,By2,Bz2对应表示第i个发射线圈中与Y轴平行的一轴线圈工作时第j个接收线圈中的与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈感应到的磁感应强度,Bx3,By3,Bz3对应表示第i个发射线圈中与Z轴平行的一轴线圈工作时第j个接收线圈中的与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈感应到的磁感应强度,B′x1,B′y1,B′z1对应表示第i个发射线圈中的与X轴平行的一轴线圈对第j个接收线圈在位置P=(x,y,z)处与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈的理论磁感应强度,B′x2,B′y2,B′z2对应表示第i个发射线圈中的与Y轴平行的一轴线圈对第j个接收线圈在位置P=(x,y,z)处与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈的理论磁感应强度,B′x3,B′y3,B′z3对应表示第i个发射线圈中的与Z轴平行的一轴线圈对第j个接收线圈在位置P=(x,y,z)处与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈的理论磁感应强度;
⑤根据步骤④中得到的每个接收线圈在被测物体内的位置和方向,利用多项式曲线拟合方法拟合得到柔性导管内窥镜的导管的运动变化以及镜头的行进轨迹,实现柔性导管内窥镜的跟踪。
所述的步骤①中的发射线圈的第一轴线圈、第二轴线圈和第三轴线圈均采用漆包线绕制,在被测物体所在空间内放置发射线圈时,其中一轴线圈平行于被测物体所在空间的地面即平行于X轴;在此,使发射线圈的一轴线圈平行于X轴,相当于建立了一个以发射线圈的三轴线圈为参考的坐标系;
所述的步骤①中的接收线圈的第一轴线圈和第二轴线圈均采用漆包线绕制,并置于柔性导管内窥镜的导管的外管壁或柔性导管内窥镜的镜头外壁上,接收线圈的第三轴线圈采用由柔性PCB板刻制而成的柔性PCB线圈,并粘贴于柔性导管内窥镜的导管的外管壁或柔性导管内窥镜的镜头外壁上,接收线圈的三轴线圈两两垂直;在此,设计的接收线圈的第三轴线圈采用由柔性PCB板刻制而成的柔性PCB线圈,并采用粘贴方式进行连接,这种接收线圈适合在导管上使用。
所述的步骤①中布置在柔性导管内窥镜的导管的外管壁上的多个接收线圈等间距分布;在此,将多个接收线圈进行等间距分布,可使后续利用每个接收线圈在被测物体内的位置和方向进行曲线拟合实现柔性导管内窥镜的跟踪更加方便。
所述的步骤②中在第i个发射线圈中的三轴线圈上各加载的正弦波交变电信号的频率均为2KHZ;在此,限定发射线圈中的三轴线圈上各加载的正弦波交变电信号的频率,方便了每个接收线圈在感应到发射线圈产生的交变电磁场后产生交变电信号并对其进行后续处理。
所述的步骤③中数据后处理的具体过程为:
③-1、令k表示迭代次数,k的初始值为1,经模数转换处理后得到的数据由N'个信号值组成,并将经模数转换处理后得到的数据记为f1,将f1中的第n'个信号值记为f1(tn'),其中,N'≥3,1≤n'≤N',tn'表示f1(tn')的采样时刻;
③-2、根据信号放大处理后得到的信号是否发生截止失真确定f1中的有效信号值的个数,如果信号放大处理后得到的信号未发生截止失真,则认为f1中的所有信号值均为有效信号值,并将f1中的有效信号值的个数记为N1,N1=N',然后执行步骤③-3;如果信号放大处理后得到的信号发生截止失真,则认为f1中值大于负截止电压且小于正截止电压的所有信号值均为有效信号值,并将f1中的有效信号值的个数记为N1,1≤N1<N',然后执行步骤③-3;
③-3、根据f1中的所有有效信号值,获取f1的幅值和相位,对应记为Am1和 其中,ω表示第i个发射线圈上加载的正弦波交变电信号的频率,表示f1中的第n1个有效信号值的采样时刻,表示f1中的第n1个有效信号值,为的逆矩阵;
③-4、根据Am1和确定f1对应的正弦波信号;再对f1对应的正弦波信号进行离散化处理,将离散化处理后得到的数据记为将中的第n'个信号值记为 其中,1≤n'≤N',表示的采样时刻,且与tn'相等;
③-5、如果信号放大处理后得到的信号未发生截止失真,则对中的信号值不作处理,然后执行步骤③-6;如果信号放大处理后得到的信号发生截止失真,则将中值大于或等于正截止电压的所有信号值替换成正截止电压值,并将中值小于或等于负截止电压的所有信号值替换成负截止电压值,然后执行步骤③-6;
③-6、根据f1和去除f1中的噪声,得到去除噪声后的数据,记为将中的第n'个信号值记为 其中,1≤n'≤N',Th表示设定的误差阈值, 表示f1中的所有有效信号值的平均值,符号“||”为取绝对值符号;
③-7、计算第k次迭代后的计算结果精度,记为δk,然后判断δk是否小于δk-1,如果是,则结束迭代过程,并将作为数据后处理得到的无噪声数据,然后按照步骤③-3的计算方法获取无噪声数据的幅值和相位;否则,将赋值给f1,然后令k=k+1,再返回步骤③-3继续迭代;其中,δk-1表示第k-1次迭代后的计算结果精度,δ0=0,k=k+1中的“=”为赋值符号。
所述的步骤③-2和所述的步骤③-4中负截止电压为-5V,正截止电压为+5V。
与现有技术相比,本发明的优点在于:
1)在柔性导管内窥镜的导管和镜头上设置的接收线圈为三轴正交线圈,采用三轴正交线圈相对于单轴线圈或双轴线圈,能够减少布置接收线圈的点数,从而满足了柔性导管内窥镜成像轨迹的平滑性。
2)在柔性导管内窥镜的导管和镜头上设置接收线圈,在被测物体所在空间内设置发射线圈,通过电磁定位的方法获取导管内窥镜上接收线圈的位置和方向,接收线圈的三维位置不受被测物体运动对线圈工作的影响,然后利用多项式曲线拟合的方法得到柔性导管内窥镜的形态,由于用柔性导管内窥镜检查时,导管的运动变化十分重要,因工作环境的复杂性和自身形状不可视等不足,在导管介入过程中会出现导管缠绕、非预期结襻等情况,因此利用本发明方法得到柔性导管内窥镜的形态,再通过显示设备的界面显示出导管的形态,可使操作者能够快速准确的操作柔性导管内窥镜进行检测。
3)使用电磁定位的方法获取接收线圈的位置和方向,从而实现柔性导管内窥镜的定位,这样利用柔性导管内窥镜进行检测时就不会对操作者产生辐射问题,解决了X光射线问题,且能为操作者快速确定操作方案提供可靠的依据。
4)对接收线圈产生的感应信号进行数据处理时,使用软件计算的方法获取磁感应强度值,解决了因硬件电路电源电压的限制造成的信号量程过小造成的定位范围小的不足,且使用软件计算的方法不需要提供额外的硬件来获取大范围的定位,降低了整体电路结构的复杂度,且具有很好的可实施性。
5)在定位与跟踪计算时,使用线性算法获得接收线圈位置和方向信息的解析解,相对于使用非线性算法的定位方法,定位过程快速,进一步对柔性导管内窥镜拟合成完整的导管轨迹时,不但可以利用各点的位置,而且可综合其线圈的轴线方向进行计算,提高了拟合的完整性和精度,定位结果准确。
附图说明
图1为本发明方法的流程框图;
图2为本发明方法中设置于柔性导管内窥镜的导管的外管壁上的接收线圈的示意图;
图3为本发明方法中接收线圈中的第三轴线圈的结构示意图。
具体实施方式
以下结合附图实施例对本发明作进一步详细描述。
本发明提出的一种工业用柔性导管内窥镜的定位跟踪方法,其流程框图如图1所示,其包括以下步骤:
①在被测物体所在空间内的不同位置处各布置一个三轴正交的电磁线圈,并将这些电磁线圈均作为发射线圈;在柔性导管内窥镜的导管的外管壁上的不同位置处及在柔性导管内窥镜的镜头上各布置一个三轴正交的电磁线圈,并将这些电磁线圈均作为接收线圈,接收线圈中的三轴线圈的工作电流一致,且半径一致;再将柔性导管内窥镜置于被测物体内。
在此,考虑到柔性导管内窥镜成像轨迹的平滑性,因此需在柔性导管内窥镜的导管的外管壁上的不同位置处各布置一个电磁线圈(接收线圈),布置在柔性导管内窥镜的导管的外管壁上的所有电磁线圈能同时独立工作,无相互干扰。在实际设计时,可要求布置在柔性导管内窥镜的导管的外管壁上的多个接收线圈等间距分布。
在本实施例中,步骤①中的发射线圈的第一轴线圈、第二轴线圈和第三轴线圈均采用漆包线绕制,发射线圈的第一轴线圈、第二轴线圈和第三轴线圈两两相互垂直,在被测物体所在空间内放置发射线圈时,其中一轴线圈平行于被测物体所在空间的地面即平行于X轴;步骤①中的接收线圈的第一轴线圈和第二轴线圈均采用漆包线绕制,并置于柔性导管内窥镜的导管的外管壁或柔性导管内窥镜的镜头外壁上,接收线圈的第三轴线圈采用由柔性PCB板刻制而成的柔性PCB线圈,并粘贴于柔性导管内窥镜的导管的外管壁或柔性导管内窥镜的镜头外壁上,接收线圈的第一轴线圈和第二轴线圈相互垂直,接收线圈的第三轴线圈分别与第一轴线圈和第二轴线圈相互垂直。三轴正交的电磁线圈由三个独立且相互垂直的线圈组成,图2给出了设置于柔性导管内窥镜的导管的外管壁上的接收线圈的示意图,图3给出了接收线圈中的第三轴线圈的结构示意图。
②当前工作的发射线圈为第i个发射线圈,则在第i个发射线圈中的三轴线圈上各加载频率为2KHZ的正弦波交变电信号作为激励信号,使第i个发射线圈在其周围产生交变电磁场,此时每个接收线圈在感应到交变电磁场后产生交变电信号,其中,1≤i≤I',I'表示在被测物体所在空间内布置的发射线圈的总个数。
由于在发射线圈上加载正弦波交变电信号作为激励信号,在周围空间中会产生变化的磁场,因此在变化的磁场中,接收线圈会感应到磁场变化,当穿过由接收线圈构成的闭合回路所限定的曲面的磁通发生变化时,闭合回路中就会产生感应电动势,接收线圈因电磁感应产生交变电信号。
③对每个接收线圈产生的交变电信号依次进行信号放大处理、信号滤波处理、模数转换处理及数据后处理,得到每个接收线圈产生的交变电信号对应的无噪声数据,并获取无噪声数据的幅值。
在具体实施时,应事先使每个接收线圈的引线紧贴柔性导管内窥镜的导管的外管壁,然后使引线与位于被测物体外部的信号放大电路的输入端连接,再连接信号放大电路的输出端与信号滤波电路的输入端、信号滤波电路的输出端与模数转换模块的输入端、模数转换模块的输出端与数据后处理模块的输入端;在此,信号放大电路、信号滤波电路、模数转换模块均采用现有技术。
在此具体实施例中,步骤③中数据后处理的具体过程为:
③-1、令k表示迭代次数,k的初始值为1,经模数转换处理后得到的数据由N'个信号值组成,并将经模数转换处理后得到的数据记为f1,将f1中的第n'个信号值记为f1(tn'),其中,N'≥3,1≤n'≤N',tn'表示f1(tn')的采样时刻。
③-2、由于信号放大处理后输出的电信号可能会受信号放大电路的电源电压的影响,因此当信号放大处理后输出的电信号受到信号放大电路的电源电压的影响时,信号放大处理后输出的电信号会出现截止失真的情况。根据信号放大处理后得到的信号是否发生截止失真确定f1中的有效信号值的个数,如果信号放大处理后得到的信号未发生截止失真,则认为f1中的所有信号值均为有效信号值,并将f1中的有效信号值的个数记为N1,N1=N',然后执行步骤③-3;如果信号放大处理后得到的信号发生截止失真,则认为f1中值大于负截止电压且小于正截止电压的所有信号值均为有效信号值,并将f1中的有效信号值的个数记为N1,1≤N1<N',然后执行步骤③-3。
在此,负截止电压为-5V,正截止电压为+5V。
③-3、根据f1中的所有有效信号值,获取f1的幅值和相位,对应记为Am1和 其中,ω表示第i个发射线圈上加载的正弦波交变电信号的频率,表示f1中的第n1个有效信号值的采样时刻,表示f1中的第n1个有效信号值,为的逆矩阵。
③-4、根据Am1和确定f1对应的正弦波信号;再对f1对应的正弦波信号进行离散化处理,将离散化处理后得到的数据记为将中的第n'个信号值记为 其中,1≤n'≤N',表示的采样时刻,且与tn'相等。
在此,负截止电压为-5V,正截止电压为+5V。
③-5、如果信号放大处理后得到的信号未发生截止失真,则对中的信号值不作处理,然后执行步骤③-6;如果信号放大处理后得到的信号发生截止失真,则将中值大于或等于正截止电压的所有信号值替换成正截止电压值,并将中值小于或等于负截止电压的所有信号值替换成负截止电压值,然后执行步骤③-6。
③-6、根据f1和去除f1中的噪声,得到去除噪声后的数据,记为将中的第n'个信号值记为 其中,1≤n'≤N',Th表示设定的误差阈值, 表示f1中的所有有效信号值的平均值,符号“||”为取绝对值符号。
③-7、计算第k次迭代后的计算结果精度,记为δk,然后判断δk是否小于δk-1,如果是,则结束迭代过程,并将作为数据后处理得到的无噪声数据,然后按照步骤③-3的计算方法获取无噪声数据的幅值和相位;否则,将赋值给f1,然后令k=k+1,再返回步骤③-3继续迭代;其中,δk-1表示第k-1次迭代后的计算结果精度,δ0=0,k=k+1中的“=”为赋值符号。
④根据无噪声数据的幅值,确定每个接收线圈在被测物体内的位置和方向,实现柔性导管内窥镜的定位,具体过程为:
④-1、根据法拉第电磁感应定律,利用无噪声数据的幅值代表的电压值,计算得到每个接收线圈中的三轴线圈各自的磁感应强度。
④-2、根据每个接收线圈中的三轴线圈各自的磁感应强度,确定每个接收线圈在空间直角坐标系中的位置即确定每个接收线圈在被测物体内的位置,将第j个接收线圈在空间直角坐标系中的位置记为P,P=(x,y,z), 其中,1≤j≤J,J表示在柔性导管内窥镜的导管的外管壁上的不同位置处及在柔性导管内窥镜的镜头上布置的接收线圈的总个数,空间直角坐标系的原点在被测物体所在空间的地面,B1'表示第i个发射线圈中的与X轴平行的一轴线圈工作时第j个接收线圈中的三轴线圈的磁感应强度之和,B2'表示第i个发射线圈中的与Y轴平行的一轴线圈工作时第j个接收线圈中的三轴线圈的磁感应强度之和,B3'表示第i个发射线圈中的与Z轴平行的一轴线圈工作时第j个接收线圈中的三轴线圈的磁感应强度之和,BT为常量,BT=μ0IR2/4,μ0为真空磁导率,I为第j个接收线圈中的线圈的工作电流,R为第j个接收线圈中的线圈的半径,(B')2=(B1')2+(B2')2+(B3')2。
④-3、根据每个接收线圈中的三轴线圈各自的磁感应强度,确定每个接收线圈在空间直角坐标系中的方向即确定每个接收线圈在被测物体内的方向,将第j个接收线圈在空间直角坐标系中的各个方向组成的向量记为Η,Η=(α,β,γ),其中,1≤j≤J,J表示在柔性导管内窥镜的导管的外管壁上的不同位置处及在柔性导管内窥镜的镜头上布置的接收线圈的总个数,空间直角坐标系的原点在被测物体所在空间的地面,α表示第j个接收线圈与空间直角坐标系的X轴的夹角,β表示第j个接收线圈与空间直角坐标系的Y轴的夹角,γ表示第j个接收线圈与空间直角坐标系的Z轴的夹角, R表示由(α,β,γ)确定的旋转矩阵,这里,Rot(x,α)表示相对于空间直角坐标系的X轴的旋转矩阵,Rot(y,β)表示相对于空间直角坐标系的Y轴的旋转矩阵,Rot(z,γ)表示相对于空间直角坐标系的Z轴的旋转矩阵,为的逆矩阵,Bx1,By1,Bz1对应表示第i个发射线圈中与X轴平行的一轴线圈工作时第j个接收线圈中的与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈感应到的磁感应强度,Bx2,By2,Bz2对应表示第i个发射线圈中与Y轴平行的一轴线圈工作时第j个接收线圈中的与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈感应到的磁感应强度,Bx3,By3,Bz3对应表示第i个发射线圈中与Z轴平行的一轴线圈工作时第j个接收线圈中的与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈感应到的磁感应强度,B′x1,B′y1,B′z1对应表示第i个发射线圈中的与X轴平行的一轴线圈对第j个接收线圈在位置P=(x,y,z)处与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈的理论磁感应强度,B′x2,B′y2,B′z2对应表示第i个发射线圈中的与Y轴平行的一轴线圈对第j个接收线圈在位置P=(x,y,z)处与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈的理论磁感应强度,B′x3,B′y3,B′z3对应表示第i个发射线圈中的与Z轴平行的一轴线圈对第j个接收线圈在位置P=(x,y,z)处与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈的理论磁感应强度。在此,理论磁感应强度可通过现有技术获取。
⑤根据步骤④中得到的每个接收线圈在被测物体内的位置和方向,利用多项式曲线拟合方法拟合得到柔性导管内窥镜的导管的运动变化以及镜头的行进轨迹,实现柔性导管内窥镜的跟踪。
利用计算机显示屏,在显示柔性导管内窥镜图像的同时,可显示出柔性导管内窥镜的导管的运动变化以及镜头的行进轨迹,为操作人员对柔性导管内窥镜的控制和调节提供了可靠准确的参考。
Claims (6)
1.一种工业用柔性导管内窥镜的定位跟踪方法,其特征在于包括以下步骤:
①在被测物体所在空间内的不同位置处各布置一个三轴正交的电磁线圈,并将这些电磁线圈均作为发射线圈;在柔性导管内窥镜的导管的外管壁上的不同位置处及在柔性导管内窥镜的镜头上各布置一个三轴正交的电磁线圈,并将这些电磁线圈均作为接收线圈,接收线圈中的三轴线圈的工作电流一致,且半径一致;再将柔性导管内窥镜置于被测物体内;
②当前工作的发射线圈为第i个发射线圈,则在第i个发射线圈中的三轴线圈上各加载正弦波交变电信号作为激励信号,使第i个发射线圈在其周围产生交变电磁场,此时每个接收线圈在感应到交变电磁场后产生交变电信号,其中,1≤i≤I',I'表示在被测物体所在空间内布置的发射线圈的总个数;
③对每个接收线圈产生的交变电信号依次进行信号放大处理、信号滤波处理、模数转换处理及数据后处理,得到每个接收线圈产生的交变电信号对应的无噪声数据,并获取无噪声数据的幅值;
④根据无噪声数据的幅值,确定每个接收线圈在被测物体内的位置和方向,实现柔性导管内窥镜的定位,具体过程为:
④-1、根据法拉第电磁感应定律,利用无噪声数据的幅值代表的电压值,计算得到每个接收线圈中的三轴线圈各自的磁感应强度;
④-2、根据每个接收线圈中的三轴线圈各自的磁感应强度,确定每个接收线圈在空间直角坐标系中的位置即确定每个接收线圈在被测物体内的位置,将第j个接收线圈在空间直角坐标系中的位置记为P,P=(x,y,z), 其中,1≤j≤J,J表示在柔性导管内窥镜的导管的外管壁上的不同位置处及在柔性导管内窥镜的镜头上布置的接收线圈的总个数,空间直角坐标系的原点在被测物体所在空间的地面,B1'表示第i个发射线圈中的与X轴平行的一轴线圈工作时第j个接收线圈中的三轴线圈的磁感应强度之和,B2'表示第i个发射线圈中的与Y轴平行的一轴线圈工作时第j个接收线圈中的三轴线圈的磁感应强度之和,B3'表示第i个发射线圈中的与Z轴平行的一轴线圈工作时第j个接收线圈中的三轴线圈的磁感应强度之和,BT为常量,BT=μ0IR2/4,μ0为真空磁导率,I为第j个接收线圈中的线圈的工作电流,R为第j个接收线圈中的线圈的半径,(B')2=(B1')2+(B2')2+(B3')2;
④-3、根据每个接收线圈中的三轴线圈各自的磁感应强度,确定每个接收线圈在空间直角坐标系中的方向即确定每个接收线圈在被测物体内的方向,将第j个接收线圈在空间直角坐标系中的各个方向组成的向量记为Η,Η=(α,β,γ),其中,1≤j≤J,J表示在柔性导管内窥镜的导管的外管壁上的不同位置处及在柔性导管内窥镜的镜头上布置的接收线圈的总个数,空间直角坐标系的原点在被测物体所在空间的地面,α表示第j个接收线圈与空间直角坐标系的X轴的夹角,β表示第j个接收线圈与空间直角坐标系的Y轴的夹角,γ表示第j个接收线圈与空间直角坐标系的Z轴的夹角, R表示由(α,β,γ)确定的旋转矩阵,这里,Rot(x,α)表示相对于空间直角坐标系的X轴的旋转矩阵,Rot(y,β)表示相对于空间直角坐标系的Y轴的旋转矩阵,Rot(z,γ)表示相对于空间直角坐标系的Z轴的旋转矩阵,为的逆矩阵,Bx1,By1,Bz1对应表示第i个发射线圈中与X轴平行的一轴线圈工作时第j个接收线圈中的与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈感应到的磁感应强度,Bx2,By2,Bz2对应表示第i个发射线圈中与Y轴平行的一轴线圈工作时第j个接收线圈中的与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈感应到的磁感应强度,Bx3,By3,Bz3对应表示第i个发射线圈中与Z轴平行的一轴线圈工作时第j个接收线圈中的与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈感应到的磁感应强度,B′x1,B′y1,B′z1对应表示第i个发射线圈中的与X轴平行的一轴线圈对第j个接收线圈在位置P=(x,y,z)处与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈的理论磁感应强度,B′x2,B′y2,B′z2对应表示第i个发射线圈中的与Y轴平行的一轴线圈对第j个接收线圈在位置P=(x,y,z)处与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈的理论磁感应强度,B′x3,B′y3,B′z3对应表示第i个发射线圈中的与Z轴平行的一轴线圈对第j个接收线圈在位置P=(x,y,z)处与X轴平行的一轴线圈、与Y轴平行的一轴线圈、与Z轴平行的一轴线圈的理论磁感应强度;
⑤根据步骤④中得到的每个接收线圈在被测物体内的位置和方向,利用多项式曲线拟合方法拟合得到柔性导管内窥镜的导管的运动变化以及镜头的行进轨迹,实现柔性导管内窥镜的跟踪。
2.根据权利要求1所述的一种工业用柔性导管内窥镜的定位跟踪方法,其特征在于所述的步骤①中的发射线圈的第一轴线圈、第二轴线圈和第三轴线圈均采用漆包线绕制,在被测物体所在空间内放置发射线圈时,其中一轴线圈平行于被测物体所在空间的地面即平行于X轴;
所述的步骤①中的接收线圈的第一轴线圈和第二轴线圈均采用漆包线绕制,并置于柔性导管内窥镜的导管的外管壁或柔性导管内窥镜的镜头外壁上,接收线圈的第三轴线圈采用由柔性PCB板刻制而成的柔性PCB线圈,并粘贴于柔性导管内窥镜的导管的外管壁或柔性导管内窥镜的镜头外壁上,接收线圈的三轴线圈两两垂直。
3.根据权利要求2所述的一种工业用柔性导管内窥镜的定位跟踪方法,其特征在于所述的步骤①中布置在柔性导管内窥镜的导管的外管壁上的多个接收线圈等间距分布。
4.根据权利要求1至3中任一项所述的一种工业用柔性导管内窥镜的定位跟踪方法,其特征在于所述的步骤②中在第i个发射线圈中的三轴线圈上各加载的正弦波交变电信号的频率均为2KHZ。
5.根据权利要求4所述的一种工业用柔性导管内窥镜的定位跟踪方法,其特征在于所述的步骤③中数据后处理的具体过程为:
③-1、令k表示迭代次数,k的初始值为1,经模数转换处理后得到的数据由N'个信号值组成,并将经模数转换处理后得到的数据记为f1,将f1中的第n'个信号值记为f1(tn'),其中,N'≥3,1≤n'≤N',tn'表示f1(tn')的采样时刻;
③-2、根据信号放大处理后得到的信号是否发生截止失真确定f1中的有效信号值的个数,如果信号放大处理后得到的信号未发生截止失真,则认为f1中的所有信号值均为有效信号值,并将f1中的有效信号值的个数记为N1,N1=N',然后执行步骤③-3;如果信号放大处理后得到的信号发生截止失真,则认为f1中值大于负截止电压且小于正截止电压的所有信号值均为有效信号值,并将f1中的有效信号值的个数记为N1,1≤N1<N',然后执行步骤③-3;
③-3、根据f1中的所有有效信号值,获取f1的幅值和相位,对应记为Am1和 其中,ω表示第i个发射线圈上加载的正弦波交变电信号的频率,表示f1中的第n1个有效信号值的采样时刻,表示f1中的第n1个有效信号值,为的逆矩阵;
③-4、根据Am1和确定f1对应的正弦波信号;再对f1对应的正弦波信号进行离散化处理,将离散化处理后得到的数据记为将中的第n'个信号值记为 其中,1≤n'≤N',表示的采样时刻,且与tn'相等;
③-5、如果信号放大处理后得到的信号未发生截止失真,则对中的信号值不作处理,然后执行步骤③-6;如果信号放大处理后得到的信号发生截止失真,则将中值大于或等于正截止电压的所有信号值替换成正截止电压值,并将中值小于或等于负截止电压的所有信号值替换成负截止电压值,然后执行步骤③-6;
③-6、根据f1和去除f1中的噪声,得到去除噪声后的数据,记为将中的第n'个信号值记为其中,1≤n'≤N',Th表示设定的误差阈值, 表示f1中的所有有效信号值的平均值,符号“||”为取绝对值符号;
③-7、计算第k次迭代后的计算结果精度,记为δk,然后判断δk是否小于δk-1,如果是,则结束迭代过程,并将作为数据后处理得到的无噪声数据,然后按照步骤③-3的计算方法获取无噪声数据的幅值和相位;否则,将赋值给f1,然后令k=k+1,再返回步骤③-3继续迭代;其中,δk-1表示第k-1次迭代后的计算结果精度,δ0=0,k=k+1中的“=”为赋值符号。
6.根据权利要求5所述的一种工业用柔性导管内窥镜的定位跟踪方法,其特征在于所述的步骤③-2和所述的步骤③-4中负截止电压为-5V,正截止电压为+5V。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410581509.XA CN104361608B (zh) | 2014-10-27 | 2014-10-27 | 一种工业用柔性导管内窥镜的定位跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410581509.XA CN104361608B (zh) | 2014-10-27 | 2014-10-27 | 一种工业用柔性导管内窥镜的定位跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104361608A CN104361608A (zh) | 2015-02-18 |
CN104361608B true CN104361608B (zh) | 2017-02-01 |
Family
ID=52528866
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410581509.XA Expired - Fee Related CN104361608B (zh) | 2014-10-27 | 2014-10-27 | 一种工业用柔性导管内窥镜的定位跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104361608B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
NZ735465A (en) * | 2015-03-05 | 2021-07-30 | Magic Leap Inc | Systems and methods for augmented reality |
CN106525029B (zh) * | 2016-12-06 | 2019-02-05 | 浙江大学宁波理工学院 | 一种圆环磁体的近场磁定位方法 |
CN109330550B (zh) * | 2018-10-17 | 2021-01-15 | 孙静 | 一种呼吸内科用光谱式超细内镜智能检查装置 |
CN113907881B (zh) * | 2020-07-07 | 2023-05-16 | 上海微创电生理医疗科技股份有限公司 | 介入装置的定位设备、方法及计算机设备、可读存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1731082A1 (en) * | 2004-03-31 | 2006-12-13 | Olympus Corporation | Probe for assisting insertion of endoscope and endoscope device using the probe |
WO2007023025A1 (de) * | 2005-07-11 | 2007-03-01 | Siemens Aktiengesellschaft | Endoskopiesystem |
CN101826780A (zh) * | 2009-03-07 | 2010-09-08 | 深圳先进技术研究院 | 驱动磁体的方法以及驱动胶囊内窥镜的方法和*** |
EP2382909A1 (en) * | 2009-01-29 | 2011-11-02 | Olympus Medical Systems Corp. | Endoscope system |
CN102499616A (zh) * | 2011-09-28 | 2012-06-20 | 天津大学 | 基于加速度传感器的内窥镜探头三维磁场定位***及定位方法 |
CN102973235A (zh) * | 2012-11-27 | 2013-03-20 | 深圳市资福技术有限公司 | 一种胶囊内窥镜及其方位控制装置 |
-
2014
- 2014-10-27 CN CN201410581509.XA patent/CN104361608B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1731082A1 (en) * | 2004-03-31 | 2006-12-13 | Olympus Corporation | Probe for assisting insertion of endoscope and endoscope device using the probe |
WO2007023025A1 (de) * | 2005-07-11 | 2007-03-01 | Siemens Aktiengesellschaft | Endoskopiesystem |
EP2382909A1 (en) * | 2009-01-29 | 2011-11-02 | Olympus Medical Systems Corp. | Endoscope system |
CN101826780A (zh) * | 2009-03-07 | 2010-09-08 | 深圳先进技术研究院 | 驱动磁体的方法以及驱动胶囊内窥镜的方法和*** |
CN102499616A (zh) * | 2011-09-28 | 2012-06-20 | 天津大学 | 基于加速度传感器的内窥镜探头三维磁场定位***及定位方法 |
CN102973235A (zh) * | 2012-11-27 | 2013-03-20 | 深圳市资福技术有限公司 | 一种胶囊内窥镜及其方位控制装置 |
Non-Patent Citations (2)
Title |
---|
"A new tracking system for three magnetic objectives";Yang WA et al.;《IEEE Transactions on Magnetics》;20101231;第46卷(第12期);4023-4029 * |
"一种磁性目标定位跟踪***的标定方法";胡超等;《集成技术》;20140930;第3卷(第5期);85-90 * |
Also Published As
Publication number | Publication date |
---|---|
CN104361608A (zh) | 2015-02-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107830813B (zh) | 激光线标记的长轴类零件图像拼接及弯曲变形检测方法 | |
CN104361608B (zh) | 一种工业用柔性导管内窥镜的定位跟踪方法 | |
CN105184214B (zh) | 一种基于声源定位和人脸检测的人体定位方法和*** | |
US20110238399A1 (en) | System and a method for mapping a magnetic field | |
US20140222409A1 (en) | System and a method for mapping a magnetic field | |
CN101861526A (zh) | 用于跟踪超声自动校准的***和方法 | |
CN101884544A (zh) | 图像获取方法及装置和x光拍片机 | |
CN110148454B (zh) | 一种摆位方法、装置、服务器及存储介质 | |
CN104019829A (zh) | 一种基于pos***的车载全景相机和线阵激光扫描仪的外参标定方法 | |
CN107101623A (zh) | 基于坐标变换的测量方法、***及装置 | |
CN103188999A (zh) | X射线诊断装置以及x射线诊断用的支架 | |
JP2010540893A (ja) | X線容積撮影による画像再構成方法 | |
Guo et al. | Vision-based measurement for rotational speed by improving Lucas–Kanade template tracking algorithm | |
An et al. | Building an omnidirectional 3-D color laser ranging system through a novel calibration method | |
CN106871900A (zh) | 船舶磁场动态检测中图像匹配定位方法 | |
CN112215871B (zh) | 一种基于机器人视觉的移动目标追踪方法及装置 | |
Li et al. | Cross-ratio–based line scan camera calibration using a planar pattern | |
CN104296658B (zh) | 一种基于虚拟双目视觉的石壁***孔检测与定位装置及定位方法 | |
CN111738971B (zh) | 一种基于线激光双目立体视觉的电路板立体扫描检测方法 | |
CN114047358A (zh) | 一种基于单目视觉的线角振动校准方法 | |
DE102021115214A1 (de) | Verzerrungskorrektur für elektromagnetische Felder mit Inside-Out-Tracking | |
JP2013250970A (ja) | 平面パネルx線画像検出器における幾何学的センサシフトを判定するための方法 | |
CN205654357U (zh) | 管片拼装位姿检测装置 | |
Troville et al. | Considerations for accurate inclusion of staff member body tracking in a top-down view virtual reality display of a scattered radiation dose map during fluoroscopic interventional procedures | |
WO2019099544A1 (en) | Geometric calibration of x-ray imaging systems |
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: 20170201 Termination date: 20211027 |