CN109805882A - 一种胶囊内窥镜定位系统及其定位方法 - Google Patents
一种胶囊内窥镜定位系统及其定位方法 Download PDFInfo
- Publication number
- CN109805882A CN109805882A CN201910106519.0A CN201910106519A CN109805882A CN 109805882 A CN109805882 A CN 109805882A CN 201910106519 A CN201910106519 A CN 201910106519A CN 109805882 A CN109805882 A CN 109805882A
- Authority
- CN
- China
- Prior art keywords
- capsule endoscope
- formula
- magnetoresistive sensor
- resistance
- magnetic
- 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
- 239000002775 capsule Substances 0.000 title claims abstract description 97
- 238000000034 method Methods 0.000 title claims abstract description 28
- 230000004807 localization Effects 0.000 title claims abstract description 11
- 238000001514 detection method Methods 0.000 claims abstract description 26
- 230000006698 induction Effects 0.000 claims description 35
- 239000003990 capacitor Substances 0.000 claims description 17
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 230000005611 electricity Effects 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 230000005389 magnetism Effects 0.000 claims 1
- 244000144985 peep Species 0.000 claims 1
- 230000008859 change Effects 0.000 abstract description 6
- 230000006872 improvement Effects 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 7
- 230000006870 function Effects 0.000 description 7
- 239000000463 material Substances 0.000 description 7
- 230000005415 magnetization Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 230000002463 transducing effect Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 210000002249 digestive system Anatomy 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 239000011521 glass Substances 0.000 description 2
- 239000003292 glue Substances 0.000 description 2
- 230000002363 herbicidal effect Effects 0.000 description 2
- 239000004009 herbicide Substances 0.000 description 2
- 230000003902 lesion Effects 0.000 description 2
- 239000000696 magnetic material Substances 0.000 description 2
- 238000009206 nuclear medicine Methods 0.000 description 2
- 229910000889 permalloy Inorganic materials 0.000 description 2
- 241000167880 Hirundinidae Species 0.000 description 1
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000006378 damage Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 201000010099 disease Diseases 0.000 description 1
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 1
- 230000005176 gastrointestinal motility Effects 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 210000000936 intestine Anatomy 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 210000002784 stomach Anatomy 0.000 description 1
Landscapes
- Endoscopes (AREA)
Abstract
本发明公开了一种胶囊内窥镜定位系统以及定位方法,系统包括永磁体、检测模块、上位机以及电源,所永磁体安装在胶囊内窥镜中,所述检测模块配置有两个或两个以上,每个所述检测模块包括磁阻传感器以及放大电路,所述磁阻传感器与放大电路的输入端相连接,各个检测模块的放大电路的输出端分别与上位机相连接,各个检测模块的磁阻传感器均设置在同一平面上且呈环形阵列分布在永磁体的外部。本发明创造在胶囊内窥镜中安装永磁体,通过设置在永磁体外部的两个或以上磁阻传感器对永磁体由于位置姿态的改变而引起的磁场变化进行检测,利用放大电路对磁阻传感器输出的电压信号进行检测,提高对胶囊内窥镜的位置姿态参数检测的准确度。
Description
技术领域
本发明涉及胶囊内窥镜技术领域,更具体地说涉及胶囊内窥镜定位系统及其定位方法。
背景技术
胶囊内窥镜技术自上世纪末出现,患者吞服之后,它能拍摄消化道图像,通过胃肠道的蠕动完成整个消化道系统的观测,避免了给患者带来较大的痛苦。经过十几年的发展,胶囊内窥镜技术已经日臻成熟,但是,从临床反馈来看,胶囊内窥镜还有很多问题需要解决。第一个是定位问题,胶囊内窥镜虽然可以对整个消化道系统进行检查,但是却无法给沿途拍摄的图像和视频进行精确的定位,而在使用胶囊内窥镜检查出病灶部位之后,要对病灶部位进行定点施药或者其他治疗措施,因此精确的定位是必须的;第二是驱动问题,现有技术中胶囊内窥镜是采用胃肠道蠕动而运动的这样一种被动式的运动方式,无法控制其行进、后退和逗留,可能会导致重要区域无法获得详细的检测。
精确的定位能够让医生获得更全面的病灶部位的信息,并作出更可靠的诊断,胶囊内窥镜的主动驱动、图像和视频的升级以及后续地定点施药等技术都是以定位为基础的,解决了定位和驱动的问题,胶囊内窥镜系统会更加完善,更多的人会接受这项技术所带来的福利。
现有技术中常规的胶囊内窥镜定位方法包括超声波定位,RF信号强度定位法,X射线和核医学显像法以及磁定位法等。超声波受到体内肠内物质的影响很大,导致定位精度较低,不能获得准确的空间位置。RF信号在不同人的不同组织之间的能量衰减不一样,导致定位算法复杂并且定位精度不高。X射线和核医学显像法对人体有伤害,无法长时间对胶囊位置进行追踪,很难广泛使用。
发明内容
本发明要解决的技术问题是:提供一种基于磁场检测的胶囊内窥镜的定位系统及其定位方法。
本发明解决其技术问题的解决方案是:
一种胶囊内窥镜定位系统,包括永磁体、检测模块、上位机以及电源,所永磁体安装在胶囊内窥镜中,所述检测模块配置有两个或两个以上,所述电源分别与各个检测模块相连接,每个所述检测模块包括磁阻传感器以及放大电路,所述磁阻传感器与放大电路的输入端相连接,各个检测模块的放大电路的输出端分别与上位机相连接,各个检测模块的磁阻传感器均设置在同一平面上且呈环形阵列分布在永磁体的外部。
作为上述技术方案的进一步改进,所述放大电路包括放大单元、调零单元以及基准电压单元,所述磁阻传感器与放大单元的输入端相连接,所述放大单元的输出端与上位机相连接,所述调零单元以及基准电压单元分别与放大单元相连接。
作为上述技术方案的进一步改进,所述放大单元包括仪表放大器芯片、电阻R1、电容C1、电容C2以及电容C3,所述仪表放大器芯片设有两个增益控制端、两个电压输入端、一个电压输出端以及一个基准电压端,所述电阻R1两端分别与仪表放大器芯片的两个增益控制端相连接,所述仪表放大器芯片的两个电压输入端分别与磁阻传感器相连接,所述仪表放大器芯片的两个电压输入端分别通过电容C1以及电容C2接地,所述电容C3的两端分别与所述仪表放大器芯片的两个电压输入端相连接,所述仪表放大器芯片的基准电压端与基准电压单元相连接。
作为上述技术方案的进一步改进,所述调零单元包括电阻R2、电阻R3、电阻R4以及电阻R5,所述电阻R2是电位器,所述电阻R2与电阻R3串联在电源与地之间,所述电阻R4一端接在电阻R2与电阻R3之间,另一端通过电阻R5与磁阻传感器相连接,所述仪表放大器芯片的其中一个电压输入端接在电阻R4与电阻R5之间。
作为上述技术方案的进一步改进,所述基准电压单元包括基准电压芯片,所述基准电压芯片的输入端与电源相连,所述基准电压芯片的输出端与仪表放大器芯片的基准电压端相连接。
作为上述技术方案的进一步改进,所述仪表放大器芯片的型号为AD623,所述基准电压芯片的型号为MC1403,所述磁阻传感器的型号为HMC1043。
本发明的有益效果是:本发明在胶囊内窥镜中安装永磁体,通过设置在永磁体外部的两个或以上磁阻传感器对永磁体由于位置姿态的改变而引起的磁场变化进行检测,利用放大电路对磁阻传感器输出的电压信号进行检测,提高对胶囊内窥镜的位置姿态参数检测的准确度。
本发明同时还公开了一种胶囊内窥镜的定位方法,包括以下步骤:
步骤100,将永磁体安装在胶囊内窥镜中,将永磁体简化为磁偶极子模型,将胶囊内窥镜简化为刚体模型;
步骤200,将两个或两个以上的磁阻传感器设置在胶囊内窥镜外部,所述磁阻传感器呈环形阵列分布,所述磁阻传感器是三轴磁阻传感器;
步骤300,建立空间直角坐标系oxyz,胶囊内窥镜的位置姿态参数定义为(x,y,z,α,β),其中(x,y,z)为胶囊内窥镜的中心坐标,α为胶囊内窥镜中轴线与z轴的夹角,β为胶囊内窥镜中轴线在xoy平面的投影与x轴的夹角;
步骤400,获取每个磁阻传感器的输出电压值;
步骤500,根据每个磁阻传感器的输出电压值,计算磁阻传感器所处位置的磁感应强度;
步骤600,根据每个磁阻传感器所处位置的磁感应强度,计算出胶囊内窥镜的位置姿态参数。
作为上述技术方案的进一步改进,步骤100中,所述永磁体的磁矩与胶囊内窥镜的中轴线重合或者平行。
作为上述技术方案的进一步改进,步骤500中,胶囊内窥镜的输出电压值与磁感应强度的关系如式1所示:
其中(V1,V2,V3)为磁阻传感器的输出电压值,(B1,B2,B3)为全局坐标系下磁阻传感器所处位置的磁感应强度,(K1,K2,K3)是转换系数,如式2所示将全局坐标系下的磁感应强度(B1,B2,B3)转换成直角坐标系下的磁感应强度(Bx,By,Bz):
根据公式r表示永磁体到空间点的位移矢量,m′表示永磁体的磁矩,H0=(m,n,p),H0是与磁矩矢量同向的单位向量,对式2进行运算得式3:
设则式3转换成式4:
设计算K值的过程包括以下步骤:
步骤510,获取一组已知的位置姿态参数,记为(ai,bi,ci,mi,ni,pi)(i=1,2,3…N);
步骤520,令式4在x方向进行简化,得到式5:
令通过最小二乘法构建误差函数如式6所示:
步骤530,分别令将式6写成矩阵的形式,得到式7:
步骤540,由式7得到(K′11,K′12,K′13);
步骤550,重复步骤520至步骤540两次,分别在步骤520中令式4在y轴以及z轴方向进行简化,得到(K′21,K'22,K'23)和(K′31,K′32,K′33),得到K值。
作为上述技术方案的进一步改进,步骤600中胶囊内窥镜的位置姿态参数是根据每个磁阻传感器所处位置的磁感应强度,利用线性算法或者非线性算法计算得到的;
设胶囊内窥镜的磁矩为m′,根据磁偶极子模型,得到胶囊内窥镜在空间的三维磁场强度矢量如式8所示:
其中r为永磁体到空间点的位移矢量,为哈密顿算子,当磁偶极子不处于坐标原点时,设其位置为rm(xm,ym,zm),空间某点的坐标为rs(xs,ys,zs),则该点与磁偶极子的相对坐标为r=rs-rm=(xs-xm,ys-ym,zs-zm);
在直角坐标系下,磁偶极子在空间任一点的磁感应强度如式9所示:
式中X=xs-xm,Y=ys-ym,Z=zs-zm,r2=(xs-xm)2+(ys-ym)2+(zs-zm)2,在(xs,ys,zs)处的磁感应强度通过步骤500计算得到;
利用非线性算法计算胶囊内窥镜的位置姿态参数,根据磁阻传感器输出建立数学方程是超定方程组,方程个数大于位置姿态参数的未知量,采用测量点残差的加权平方和作为目标函数,使用最小二乘法求解,目标函数如式10所示:
设磁阻传感器配置有N个,是任意一个磁阻传感器的磁感应强度分量测量值,记作Bk,k=1,2,3......3N,分别等于 将 分别转换成残差形式,如式11所示:
其中(xmi,ymi,zmi)是第i个磁阻传感器的坐标,通过磁阻传感器所检测的空间点的磁感应强度,具有三个方向向量,取其残差平方和的开方,作为位姿姿态求解准则,通过以上3N个式11方程的求解,确定永磁体的位置姿态参数;
利用线性算法计算胶囊内窥镜的位置姿态参数,对式8进行简化,设将式8简化为式12:
式中H0是与磁矩矢量同向的单位向量,令H0=(m,n,p),式12中等式两边先与r进行向量积得到:
(Bl×r)·H0=0 式13
将式13改写成分量的形式得到:
对式14进行化简得到:
由式15得到胶囊内窥镜的位置姿态参数。
本发明的有益效果是:本发明利用两个或以上的磁阻传感器实现胶囊内窥镜位置姿态参数的检测,利用逆推算法通过磁阻传感器的输出电压值得到空间磁感应强度值,最后再利用线性算法或者非线性算法根据空间磁感应强度计算出胶囊内窥镜额位置姿态参数。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单说明。显然,所描述的附图只是本发明的一部分实施例,而不是全部实施例,本领域的技术人员在不付出创造性劳动的前提下,还可以根据这些附图获得其他设计方案和附图。
图1是本发明创造的磁阻传感器分布示意图;
图2是本发明创造的放大电路原理图;
图3是本发明创造的磁偶极子模型示意图;
图4是本发明创造的方法流程图。
具体实施方式
以下将结合实施例和附图对本发明的构思、具体结构及产生的技术效果进行清楚、完整的描述,以充分地理解本发明的目的、特征和效果。显然,所描述的实施例只是本申请的一部分实施例,而不是全部实施例,基于本申请的实施例,本领域的技术人员在不付出创造性劳动的前提下所获得的其他实施例,均属于本申请保护的范围。另外,文中所提到的所有连接关系,并非单指构件直接相接,而是指可根据具体实施情况,通过添加或减少连接辅件,来组成更优的连接结构。本发明创造中的各个技术特征,在不互相矛盾冲突的前提下可以交互组合。最后需要说明的是,如文中术语“中心、上、下、左、右、竖直、水平、内、外”等指示的方位或位置关系则为基于附图所示的方位或位置关系,仅是为了便于描述本技术方案和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本申请的限制。
参照图1~图2,为了解决现有技术中胶囊内窥镜难以实现精准定位的技术问题,本技术方案提供了一种胶囊内窥镜的定位系统。
一种胶囊内窥镜定位系统的第一实施例,包括永磁体1、检测模块、上位机以及电源,所永磁体1安装在胶囊内窥镜中,所述检测模块配置有两个或两个以上,所述电源分别与各个检测模块相连接,每个所述检测模块包括磁阻传感器2以及放大电路,所述磁阻传感器2与放大电路的输入端相连接,各个检测模块的放大电路的输出端分别与上位机相连接,各个检测模块的磁阻传感器2均设置在同一平面上且呈环形阵列分布在永磁体1的外部,本领域技术人员根据现有技术中的各种固定安装结构实现磁阻传感器2的固定,所述磁阻传感器2是三轴磁阻传感器2。需要说明的是所述磁阻传感器2是根据磁性材料的磁阻效应制成的,磁性材料(如坡莫合金)具有各向异性,对它进行磁化时,其磁化方向将取决于材料的易磁化轴、材料的形状和磁化磁场的方向,当给带状坡莫合金材料通电流时,材料的电阻取决于电流的方向与磁化方向的夹角,如果给材料施加一个磁场(被测磁场),就会使原来的磁化方向转动,如果磁化方向转向垂直于电流的方向,则材料的电阻将减小;如果磁化方向转向平行于电流的方向,则材料的电阻将增大,磁阻传感器2一般由四个这样的电阻组成,并将它们接成电桥,在被测磁场作用下,电桥中位于相对位置的两个电阻阻值增大,另外两个电阻的阻值减小。在其线性范围内,电桥的输出电压与被测磁场成正比。简单来说,所述磁阻传感器2能够将磁场的变化转换成其自身阻值的变化。
具体地,而胶囊内窥镜在移动过程中,其位置以及姿态都会不断的发生变化,但是其内部的永磁体1在胶囊内窥镜中的位置不会发生变化,因此胶囊内窥镜的位置及姿态发生变化时,胶囊内窥镜自身附近空间的磁场同样也会随之而变化,本技术方案利用各个磁阻传感器2对胶囊内窥镜附近空间的磁场进行检测,上位机即可得出胶囊内窥镜的实时位置以及状态;利用放大电路对磁阻传感器2输出的电压信号进行检测,提高对胶囊内窥镜的位置姿态参数检测的准确度。
进一步地,本实施例中,所述放大电路包括放大单元、调零单元以及基准电压单元,所述磁阻传感器2与放大单元的输入端相连接,所述放大单元的输出端与上位机相连接,所述调零单元以及基准电压单元分别与放大单元相连接。具体地,由于胶囊内窥镜中的永磁体1所产生的磁场较弱,因此磁阻传感器2所输出的电信号较弱,需要利用放大单元对其进行放大操作,同时也由于磁阻传感器2内部的元件参数无法改变,因此需要通过外部手段实现调零功能,所述基准电压单元用于向放大单元提供基准电压信号。
进一步地,本实施例中,所述放大单元包括仪表放大器芯片、电阻R1、电容C1、电容C2以及电容C3,所述仪表放大器芯片设有两个增益控制端、两个电压输入端、一个电压输出端以及一个基准电压端,所述电阻R1两端分别与仪表放大器芯片的两个增益控制端相连接,所述仪表放大器芯片的两个电压输入端分别与磁阻传感器2相连接,所述仪表放大器芯片的两个电压输入端分别通过电容C1以及电容C2接地,所述电容C3的两端分别与所述仪表放大器芯片的两个电压输入端相连接,所述仪表放大器芯片的基准电压端与基准电压单元相连接。
进一步地,本实施例中,所述调零单元包括电阻R2、电阻R3、电阻R4以及电阻R5,所述电阻R2是电位器,所述电阻R2与电阻R3串联在电源与地之间,所述电阻R4一端接在电阻R2与电阻R3之间,另一端通过电阻R5与磁阻传感器2相连接,所述仪表放大器芯片的其中一个电压输入端接在电阻R4与电阻R5之间,通过调节电阻R2的阻值大小即可改变电阻R2和电阻R3的连接点处的电位,进一步改变电阻R4和电阻R5的连接点处的电位,从而实现调零操作。
进一步地,本实施例中,所述基准电压单元包括基准电压芯片,所述基准电压芯片的输入端与电源相连,所述基准电压芯片的输出端与仪表放大器芯片的基准电压端相连接。具体地,本实施例中所述基准电压单元是利用集成电路芯片,将电源的输出电压转换成另一个恒定的电压值,有效简化基准电压单元的电路结构。
进一步地,本实施例中,所述仪表放大器芯片的型号优先选择为AD623,所述基准电压芯片的型号优先选择为MC1403,所述磁阻传感器2的型号为HMC1043。所述型号的仪表放大器芯片一款集成单电源仪表放大器芯片,它能在单电源(+3v~+12v)下提供满电源幅度的输出,AD623允许使用单个增益设置电阻进行增益编程,以得到良好的用户灵活性,在无外接电阻的条件下,AD623被设置为单位增益,外接电阻后,AD623可编程设置增益,其增益最高可达1000倍,AD623通过提供极好的随增益增大而增大的交流共模抑制比而保持最小的误差,线路噪声及谐波将由于共模抑制比在高达200hz时仍保持恒定而受到抑制;所述型号的基准电压芯片是美国摩托罗拉公司生产的一种新型的参考电压器件,它是利用一个负温度系数的基射结正向电压与正温度系数的工作在不同电流密度下,两个晶体管基射结电压差相加而形成的零温度系数的参考电压源,因此所述型号的基准电压芯片适用于高精度低漂移能隙基准电源。所述型号的磁阻传感器2是一种三轴表面安装的传感器序列系统,适用于低磁场检测,该型号的磁阻传感器2采用霍尼韦尔各向异性磁阻技术,具有胜过线圈型磁传感器的优点。
参照图3和图4,本技术方案同时还提供了一种胶囊内窥镜的定位方法,包括以下步骤:
步骤100,将永磁体1安装在胶囊内窥镜中,将永磁体1简化为磁偶极子模型,将胶囊内窥镜简化为刚体模型;
步骤200,将两个或两个以上的磁阻传感器2设置在胶囊内窥镜外部,所述磁阻传感器2呈环形阵列分布,所述磁阻传感器2是三轴磁阻传感器2;
步骤300,建立空间直角坐标系oxyz,胶囊内窥镜的位置姿态参数定义为(x,y,z,α,β),其中(x,y,z)为胶囊内窥镜的中心坐标,α为胶囊内窥镜中轴线与z轴的夹角,β为胶囊内窥镜中轴线在xoy平面的投影与x轴的夹角;
步骤400,获取每个磁阻传感器2的输出电压值;
步骤500,根据每个磁阻传感器2的输出电压值,通过逆推算法计算磁阻传感器2所处位置的磁感应强度;
步骤600,根据每个磁阻传感器2所处位置的磁感应强度,利用线性算法或者非线性算法计算出胶囊内窥镜的位置姿态参数。
进一步地,本技术方案中,步骤100中,所述永磁体1的磁矩与胶囊内窥镜的中轴线重合或者平行,计算出永磁体1的位置姿态参数后,无需再进多多一步运算,能够有效简化计算流程。
进一步地,本技术方案中步骤500中,胶囊内窥镜的输出电压值与磁感应强度的关系如式1所示:
其中(V1,V2,V3)为磁阻传感器2的输出电压值,(B1,B2,B3)为全局坐标系下磁阻传感器2所处位置的磁感应强度,(K1,K2,K3)是转换系数,如式2所示将全局坐标系下的磁感应强度(B1,B2,B3)转换成直角坐标系下的磁感应强度(Bx,By,Bz):
根据公式r表示永磁体到空间点的位移矢量,m′表示永磁体的磁矩,H0=(m,n,p),H0是与磁矩矢量同向的单位向量,相当于方向参数,对式2进行运算可得式3:
其中(a,b,c)为已知点(即磁阻传感器)的坐标,(xl,yl,zl)表示磁偶极子的坐标,Rl是磁偶极子到已知点(即磁阻传感器)的距离,设则式3转换成式4:
设计算K值的过程包括以下步骤:
步骤510,获取一组已知的位置姿态参数,记为(ai,bi,ci,mi,ni,pi)(i=1,2,3…N);
步骤520,令式4在x方向进行简化,可得式5:
令通过最小二乘法构建误差函数如式6所示:
步骤530,分别令将式6写成矩阵的形式,得到式7:
步骤540,由式7可得(K′11,K′12,K′13);
步骤550,重复步骤520至步骤540两次,分别在步骤520中令式4在y轴以及z轴方向进行简化,得到(K′21,K'22,K'23)和(K′31,K′32,K′33),得到K值。
进一步地,本技术方案中,步骤600中胶囊内窥镜的位置姿态参数是根据每个磁阻传感器2所处位置的磁感应强度,利用线性算法或者非线性算法计算得到的;
设胶囊内窥镜的磁矩为m′,根据磁偶极子模型,可得胶囊内窥镜在空间的三维磁场强度矢量如式8所示:
其中r为永磁体1到空间点的位移矢量,为哈密顿算子,当磁偶极子不处于坐标原点时,设其位置为rm(xm,ym,zm),空间某点的坐标为rs(xs,ys,zs),则该点与磁偶极子的相对坐标为r=rs-rm=(xs-xm,ys-ym,zs-zm);
在直角坐标系下,磁偶极子在空间任一点的磁感应强度如式9所示:
式中X=xs-xm,Y=ys-ym,Z=zs-zm,r2=(xs-xm)2+(ys-ym)2+(zs-zm)2,在(xs,ys,zs)处的磁感应强度通过步骤500计算得到;
利用非线性算法计算胶囊内窥镜的位置姿态参数,根据磁阻传感器2输出建立数学方程是超定方程组,方程个数大于位置姿态参数的未知量,采用测量点残差的加权平方和作为目标函数,使用最小二乘法求解,目标函数如式10所示:
设磁阻传感器2配置有N个,是任意一个磁阻传感器2的磁感应强度分量测量值,记作Bk,k=1,2,3......3N,分别等于 将 分别转换成残差形式,如式11所示:
其中(xmi,ymi,zmi)是第i个磁阻传感器2的坐标,通过磁阻传感器2所检测的空间点的磁感应强度,具有三个方向向量,取其残差平方和的开方,作为位姿姿态求解准则,通过以上3N个式11方程的求解,可以确定永磁体1的位置姿态参数;
利用线性算法计算胶囊内窥镜的位置姿态参数,对式8进行简化,设将式8简化为式12:
式中H0是与磁矩矢量同向的单位向量,令H0=(m,n,p),式12中等式两边先与r进行向量积可以得:
(Bl×r)·H0=0 式13
将式13改写成分量的形式可得:
对式14进行化简可得:
由式15可得胶囊内窥镜的位置姿态参数。
本技术方案通过建立线性和非线性两种算法对胶囊内窥镜的位置姿态参数进行计算,其中非线性算法具有较高精度,假若选取的初始值不合适,计算速度慢,并且可能失败,得不到全局最优解;线性算法特点是计算时间短,速度快,精度低。
以上对本申请的较佳实施方式进行了具体说明,但本申请并不限于所述实施例,熟悉本领域的技术人员在不违背本发明精神的前提下还可作出种种的等同变型或替换,这些等同的变型或替换均包含在本申请权利要求所限定的范围内。
Claims (10)
1.一种胶囊内窥镜定位系统,其特征在于:包括永磁体(1)、检测模块、上位机以及电源,所永磁体(1)安装在胶囊内窥镜中,所述检测模块配置有两个或两个以上,所述电源分别与各个检测模块相连接,每个所述检测模块包括磁阻传感器(2)以及放大电路,所述磁阻传感器(2)与放大电路的输入端相连接,各个检测模块的放大电路的输出端分别与上位机相连接,各个检测模块的磁阻传感器(2)均设置在同一平面上且呈环形阵列分布在永磁体(1)的外部。
2.根据权利要求1所述的一种胶囊内窥镜定位系统,其特征在于:所述放大电路包括放大单元、调零单元以及基准电压单元,所述磁阻传感器(2)与放大单元的输入端相连接,所述放大单元的输出端与上位机相连接,所述调零单元以及基准电压单元分别与放大单元相连接。
3.根据权利要求2所述的一种胶囊内窥镜定位系统,其特征在于:所述放大单元包括仪表放大器芯片、电阻R1、电容C1、电容C2以及电容C3,所述仪表放大器芯片设有两个增益控制端、两个电压输入端、一个电压输出端以及一个基准电压端,所述电阻R1的两端分别与仪表放大器芯片的两个增益控制端相连接,所述仪表放大器芯片的两个电压输入端分别与磁阻传感器(2)相连接,所述仪表放大器芯片的两个电压输入端分别通过电容C1以及电容C2接地,所述电容C3的两端分别与所述仪表放大器芯片的两个电压输入端相连接,所述仪表放大器芯片的基准电压端与基准电压单元相连接,所述仪表放大器芯片的电压输出端与上位机相连接。
4.根据权利要求3所述的一种胶囊内窥镜定位系统,其特征在于:所述调零单元包括电阻R2、电阻R3、电阻R4以及电阻R5,所述电阻R2是电位器,所述电阻R2与电阻R3串联在电源与地之间,所述电阻R4一端接在电阻R2与电阻R3之间,另一端通过电阻R5与磁阻传感器(2)相连接,所述仪表放大器芯片的其中一个电压输入端接在电阻R4与电阻R5之间。
5.根据权利要求4所述的一种胶囊内窥镜定位系统,其特征在于:所述基准电压单元包括基准电压芯片,所述基准电压芯片的输入端与电源相连,所述基准电压芯片的输出端与仪表放大器芯片的基准电压端相连接。
6.根据权利要求5所述的一种胶囊内窥镜定位系统,其特征在于:所述仪表放大器芯片的型号为AD623,所述基准电压芯片的型号为MC1403,所述磁阻传感器(2)的型号为HMC1043。
7.一种胶囊内窥镜定位方法,其特征在于,包括:
步骤100,将永磁体安装在胶囊内窥镜中,将永磁体简化为磁偶极子模型,将胶囊内窥镜简化为刚体模型;
步骤200,将两个或两个以上的磁阻传感器设置在胶囊内窥镜外部,所述磁阻传感器呈环形阵列分布,所述磁阻传感器是三轴磁阻传感器;
步骤300,建立空间直角坐标系oxyz,胶囊内窥镜的位置姿态参数定义为(x,y,z,α,β),其中(x,y,z)为胶囊内窥镜的中心坐标,α为胶囊内窥镜中轴线与z轴的夹角,β为胶囊内窥镜中轴线在xoy平面的投影与x轴的夹角;
步骤400,获取每个磁阻传感器的输出电压值;
步骤500,根据每个磁阻传感器的输出电压值,计算磁阻传感器所处位置的磁感应强度;
步骤600,根据每个磁阻传感器所处位置的磁感应强度,计算出胶囊内窥镜的位置姿态参数。
8.根据权利要求7所述的一种胶囊内窥镜定位方法,其特征在于,步骤100中,所述永磁体的磁矩与胶囊内窥镜的中轴线重合或者平行。
9.根据权利要求8所述的一种胶囊内窥镜定位方法,其特征在于,步骤500中,胶囊内窥镜的输出电压值与磁感应强度的关系如式1所示:
其中(V1,V2,V3)为磁阻传感器的输出电压值,(B1,B2,B3)为全局坐标系下磁阻传感器所处位置的磁感应强度,(K1,K2,K3)是转换系数,如式2所示将全局坐标系下的磁感应强度(B1,B2,B3)转换成直角坐标系下的磁感应强度(Bx,By,Bz):
根据公式r表示永磁体到空间点的位移矢量,m′表示永磁体的磁矩,H0=(m,n,p),H0是与磁矩矢量同向的单位向量,对式2进行运算得到式3:
设则式3转换成式4:
设计算K值的过程包括以下步骤:
步骤510,获取一组已知的位置姿态参数,记为(ai,bi,ci,mi,ni,pi)(i=1,2,3…N);
步骤520,令式4在x方向进行简化,得到式5:
令通过最小二乘法构建误差函数如式6所示:
步骤530,分别令将式6写成矩阵的形式,得到式7:
步骤540,由式7得到(K'11,K'12,K'13);
步骤550,重复步骤520至步骤540两次,分别在步骤520中令式4在y轴以及z轴方向进行简化,得到(K'21,K'22,K'23)和(K'31,K'32,K'33),得到K值。
10.根据权利要求9所述的一种胶囊内窥镜定位方法,其特征在于,步骤600中胶囊内窥镜的位置姿态参数是根据每个磁阻传感器所处位置的磁感应强度,利用线性算法或者非线性算法计算得到的;
设胶囊内窥镜的磁矩为m′,根据磁偶极子模型,得到胶囊内窥镜在空间的三维磁场强度矢量如式8所示:
其中r为永磁体到空间点的位移矢量,为哈密顿算子,当磁偶极子不处于坐标原点时,设其位置为rm(xm,ym,zm),空间某点的坐标为rs(xs,ys,zs),则该点与磁偶极子的相对坐标为r=rs-rm=(xs-xm,ys-ym,zs-zm);
在直角坐标系下,磁偶极子在空间任一点的磁感应强度如式9所示:
式中X=xs-xm,Y=ys-ym,Z=zs-zm,r2=(xs-xm)2+(ys-ym)2+(zs-zm)2,在(xs,ys,zs)处的磁感应强度通过步骤500计算得到;
利用非线性算法计算胶囊内窥镜的位置姿态参数,根据磁阻传感器输出建立数学方程是超定方程组,方程个数大于位置姿态参数的未知量,采用测量点残差的加权平方和作为目标函数,使用最小二乘法求解,目标函数如式10所示:
设磁阻传感器配置有N个,是任意一个磁阻传感器的磁感应强度分量测量值,记作Bk,k=1,2,3......3N,分别等于 将 分别转换成残差形式,如式11所示:
其中(xmi,ymi,zmi)是第i个磁阻传感器的坐标,通过磁阻传感器所检测的空间点的磁感应强度,具有三个方向向量,取其残差平方和的开方,作为位姿姿态求解准则,通过以上3N个式11方程的求解,确定永磁体的位置姿态参数;
利用线性算法计算胶囊内窥镜的位置姿态参数,对式8进行简化,设将式8简化为式12:
式中H0是与磁矩矢量同向的单位向量,令H0=(m,n,p),式12中等式两边先与r进行向量积得到:
(Bl×r)·H0=0式13
将式13改写成分量的形式得:
对式14进行化简得:
由式15得到胶囊内窥镜的位置姿态参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910106519.0A CN109805882A (zh) | 2019-02-02 | 2019-02-02 | 一种胶囊内窥镜定位系统及其定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910106519.0A CN109805882A (zh) | 2019-02-02 | 2019-02-02 | 一种胶囊内窥镜定位系统及其定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109805882A true CN109805882A (zh) | 2019-05-28 |
Family
ID=66605152
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910106519.0A Pending CN109805882A (zh) | 2019-02-02 | 2019-02-02 | 一种胶囊内窥镜定位系统及其定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109805882A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111134843A (zh) * | 2020-02-04 | 2020-05-12 | 赵天力 | 一种在超声切面上获得超声探头中轴线的方法及装置 |
CN112043550A (zh) * | 2020-09-29 | 2020-12-08 | 深圳睿瀚医疗科技有限公司 | 一种基于磁标记的舌控手部康复机器人系统及其操作方法 |
CN114159163A (zh) * | 2021-12-13 | 2022-03-11 | 南开大学 | 面向软镜的磁导航系统和方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102670158A (zh) * | 2012-05-10 | 2012-09-19 | 无锡市华焯光电科技有限公司 | 一种可定位胶囊内窥镜系统 |
CN103300862A (zh) * | 2013-05-24 | 2013-09-18 | 浙江大学宁波理工学院 | 一种胶囊内窥镜病灶组织深度和三维尺寸的测量方法 |
CN204789958U (zh) * | 2015-05-06 | 2015-11-18 | 广州番禺职业技术学院 | 一种磁阻传感器工作电路 |
-
2019
- 2019-02-02 CN CN201910106519.0A patent/CN109805882A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102670158A (zh) * | 2012-05-10 | 2012-09-19 | 无锡市华焯光电科技有限公司 | 一种可定位胶囊内窥镜系统 |
CN103300862A (zh) * | 2013-05-24 | 2013-09-18 | 浙江大学宁波理工学院 | 一种胶囊内窥镜病灶组织深度和三维尺寸的测量方法 |
CN204789958U (zh) * | 2015-05-06 | 2015-11-18 | 广州番禺职业技术学院 | 一种磁阻传感器工作电路 |
Non-Patent Citations (1)
Title |
---|
刘畅: ""体内胶囊微机电系统主动驱动机理及定位技术研究"", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111134843A (zh) * | 2020-02-04 | 2020-05-12 | 赵天力 | 一种在超声切面上获得超声探头中轴线的方法及装置 |
CN112043550A (zh) * | 2020-09-29 | 2020-12-08 | 深圳睿瀚医疗科技有限公司 | 一种基于磁标记的舌控手部康复机器人系统及其操作方法 |
CN112043550B (zh) * | 2020-09-29 | 2023-08-18 | 深圳睿瀚医疗科技有限公司 | 一种基于磁标记的舌控手部康复机器人系统及其操作方法 |
CN114159163A (zh) * | 2021-12-13 | 2022-03-11 | 南开大学 | 面向软镜的磁导航系统和方法 |
CN114159163B (zh) * | 2021-12-13 | 2022-09-16 | 南开大学 | 面向软镜的磁导航系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Hu et al. | A cubic 3-axis magnetic sensor array for wirelessly tracking magnet position and orientation | |
CN109805882A (zh) | 一种胶囊内窥镜定位系统及其定位方法 | |
Hu et al. | Efficient magnetic localization and orientation technique for capsule endoscopy | |
US11250318B2 (en) | Method and/or system for magnetic localization | |
WO2016196985A1 (en) | Active magnetic position sensor | |
Wang et al. | Multipoint simultaneous tracking of wireless capsule endoscope using magnetic sensor array | |
Hu et al. | An improved magnetic localization and orientation algorithm for wireless capsule endoscope | |
US20200372409A1 (en) | Electromagnetic distortion compensation for device tracking | |
US11058321B2 (en) | Current driven sensor for magnetic navigation | |
JP2019080934A (ja) | 位置追跡システム | |
CA2761547A1 (en) | Probe tracking using multiple tracking methods | |
Hu et al. | 3-axis magnetic sensor array system for tracking magnet's position and orientation | |
Hu et al. | The calibration of 3-axis magnetic sensor array system for tracking wireless capsule endoscope | |
CN109459712A (zh) | 基于亥姆霍兹线圈的矢量闭环补偿式三轴磁场传感器探头 | |
Hu et al. | Efficient linear algorithm for magnetic localization and orientation in capsule endoscopy | |
Sun et al. | A non-invasive real-time localization system for enhanced efficacy in nasogastric intubation | |
EP3555565B1 (en) | Dominant axis navigation sensor | |
Hu et al. | A new 6D magnetic localization technique for wireless capsule endoscope based on a rectangle magnet | |
US20180220927A1 (en) | Electromagnetic navigation system with magneto-resistive sensors and application-specific integrated circuits | |
US20240023823A1 (en) | Location and orientation estimation of devices incorporating permanent magnets | |
Song et al. | Real time algorithm for magnet's localization in capsule endoscope | |
US10835151B2 (en) | Sensor assemblies for electromagnetic navigation systems | |
JP7286407B2 (ja) | 位置センサを含むカテーテルの較正治具 | |
Li et al. | A new calibration method for magnetic sensor array for tracking capsule endoscope | |
Guo et al. | A novel method of three-dimensional localization based on a neural network algorithm |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190528 |