CN108186017A - 一种用于确定内窥镜胶囊体内位姿的检测系统和方法 - Google Patents

一种用于确定内窥镜胶囊体内位姿的检测系统和方法 Download PDF

Info

Publication number
CN108186017A
CN108186017A CN201711232178.9A CN201711232178A CN108186017A CN 108186017 A CN108186017 A CN 108186017A CN 201711232178 A CN201711232178 A CN 201711232178A CN 108186017 A CN108186017 A CN 108186017A
Authority
CN
China
Prior art keywords
magnetic
current density
sensor array
magnetic current
pose
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.)
Granted
Application number
CN201711232178.9A
Other languages
English (en)
Other versions
CN108186017B (zh
Inventor
李敬
郝阳
黄强
周基阳
保罗·达里奥
加斯托内·丘蒂
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Technology BIT
Original Assignee
Beijing Institute of Technology BIT
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 Beijing Institute of Technology BIT filed Critical Beijing Institute of Technology BIT
Priority to CN201711232178.9A priority Critical patent/CN108186017B/zh
Publication of CN108186017A publication Critical patent/CN108186017A/zh
Application granted granted Critical
Publication of CN108186017B publication Critical patent/CN108186017B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00Measuring for diagnostic purposes; Identification of persons
    • A61B5/06Devices, other than using radiation, for detecting or locating foreign bodies ; determining position of probes within or on the body of the patient
    • A61B5/061Determining position of a probe within the body employing means separate from the probe, e.g. sensing internal probe position employing impedance electrodes on the surface of the body
    • A61B5/062Determining position of a probe within the body employing means separate from the probe, e.g. sensing internal probe position employing impedance electrodes on the surface of the body using magnetic field
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor
    • A61B1/04Instruments for performing medical examinations of the interior of cavities or tubes of the body by visual or photographical inspection, e.g. endoscopes; Illuminating arrangements therefor combined with photographic or television appliances
    • A61B1/041Capsule endoscopes for imaging
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00Measuring for diagnostic purposes; Identification of persons
    • A61B5/07Endoradiosondes
    • A61B5/073Intestinal transmitters

Landscapes

  • Life Sciences & Earth Sciences (AREA)
  • Health & Medical Sciences (AREA)
  • Surgery (AREA)
  • Engineering & Computer Science (AREA)
  • Molecular Biology (AREA)
  • General Health & Medical Sciences (AREA)
  • Pathology (AREA)
  • Biomedical Technology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Medical Informatics (AREA)
  • Physics & Mathematics (AREA)
  • Veterinary Medicine (AREA)
  • Animal Behavior & Ethology (AREA)
  • Biophysics (AREA)
  • Public Health (AREA)
  • Human Computer Interaction (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Optics & Photonics (AREA)
  • Radiology & Medical Imaging (AREA)
  • Endoscopes (AREA)
  • Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)

Abstract

本发明公开了一种用于确定内窥镜胶囊体内位姿的检测系统和方法。本发明通过实时获知磁源位置,相应地移动磁传感器阵列,以可移动的小型磁传感器阵列代替固定不动的大型磁传感器阵列,以减少传感器阵列的规模,从而减少非线性优化算法的计算量,并使磁源处于检测阵列可检测范围内的较好位置,能够使磁传感器阵列始终保持较高的检测精度。

Description

一种用于确定内窥镜胶囊体内位姿的检测系统和方法
技术领域
本发明涉及磁场检测技术领域,具体涉及一种用于确定内窥镜胶囊体内位姿的检测系统和方法。
背景技术
安装有微型摄像头的内窥镜胶囊可由吞服或肛门插入等方式,经过人体自然孔口进入人体消化道内,拍摄消化道内壁的图像并输出到显示设备上,辅助医生诊察消化道内壁的病变。在内窥镜胶囊中内置磁源,并使用外部设备对该磁源所产生的磁流密度进行检测、运行定位算法,可获得内窥镜胶囊在人体消化道中的位置和姿态,有助于提高内窥镜胶囊的诊察效率和性能。
现有技术(专利号US005762064A)公布了一种方案,利用固定于人体外的空间中某位置的磁传感器(至少两个三轴磁传感器),检测置于人体内部的带有磁源的医学设备所产生的磁流密度,再通过定位算法处理所采集的各传感器的磁流密度,可估计位于人体内的带有磁源的医学设备的位置和姿态。
但是,该方法只适用于磁源运动范围较小的情况,仅需使用较少数量的磁传感器组成较小规模的阵列即可满足磁源位置和姿态测量的实际应用需求。然而,带有内置磁源的内窥镜胶囊需要在人体胃肠道中做较大范围的运动,进而会涉及更多磁传感器形成较大规模的磁传感器阵列以覆盖内窥镜胶囊的整个运动区域。更多的磁传感器将会同时测得更多组磁流密度测量值,这将对运行定位算法的数据处理系统造成更多计算负担,不利于提高系统的实时性。而且,在较大规模的磁传感器阵列中,距离磁源较远的磁传感器测得的磁信号容易受到环境中各种磁噪声的影响(例如地磁场),不利于提高系统的综合测量精度。
发明内容
有鉴于此,本发明提供了一种用于确定内窥镜胶囊体内位姿的检测系统和方法,不仅能够提高系统的实时性,而且不易受到磁噪声影响。
一种用于确定内窥镜胶囊体内位姿的方法,采用M×N个三轴磁流密度传感器组成的磁传感器阵列进行体外探测;内窥镜胶囊内设有磁源,并将内窥镜胶囊置于体内;将磁传感器阵列与运动设备固连,通过磁传感器阵列实时获得体内磁源的位姿,并根据所述位姿,通过控制运动设备,实现磁传感器阵列与磁源的跟随。
较佳地,其具体实现方法为:
步骤一、获取各磁流密度传感器的磁流密度值
在任意采样时刻,第i行第j列的磁流密度传感器的三个正交方向的磁流密度值由当前位置的磁流密度传感器采集获得;其中,i∈[1,M],j∈[1,N];
步骤二、获得磁源位姿
将步骤一中获得各磁流密度传感器的磁流密度值、磁源指向对应磁传感器的三维空间矢量、真空磁导率和磁矩代入磁偶极子磁流密度分布式,获得磁源位姿;
步骤三、获得从磁源位置垂直指向磁传感器阵列的方向上各点的磁流密度值,以最接近设定的参考磁流密度值的点作为磁传感器阵列的目标移动位置;
步骤四、根据步骤三中获得的目标移动位置,控制运动设备带动磁传感器阵列向目标移动位置移动。
较佳地,所述步骤三中获得目标移动位置的具体方法为:
步骤3.1A、按设定步长距离在由磁源位置垂直指向磁传感器阵列的方向上划分出K个点,利用磁偶极子磁流密度分布式,获得每个点三个正交方向上的磁流密度值;
步骤3.2A、遍历K个点,获得每个点在三个正交方向中最大磁流密度值;
步骤3.3A、设置参考磁流密度值;
步骤3.4A、分别求取各点的最大磁流密度值与参考磁流密度值的绝对差值,令绝对差值最小的值所对应的点作为目标移动位置。
较佳地,步骤3.3A中设定参考磁流密度值的具体方法为:
设定一测量裕度参数η,令参考磁流密度值Ba=ηBs,其中Bs为量程上限。
较佳地,所述步骤三中获得目标移动位置的具体方法为:
步骤3.1B、按设定步长距离在由磁源位置垂直指向磁传感器阵列的方向上划分出K个点,利用磁偶极子磁流密度分布式,获得每个点三个正交方向上的磁流密度值;
步骤3.2B、根据步骤3.1B中获得的各方向上的磁流密度值,遍历K个点,获得每个点磁流密度模值;
步骤3.3B、设定参考磁流密度值;
步骤3.4B、分别求取各点的磁流密度模值与参考磁流密度值的绝对差值,令绝对差值最小的值所对应的点作为目标移动位置。
较佳地,所述步骤3.3B中设定参考磁流密度值的具体方法为:
设定一测量裕度参数η,令参考磁流密度值Ba=ηBs,其中Bs为磁流密度传感器的量程上限。
较佳地,所述步骤四中,根据运动设备的实际情况,以目标移动位置为目标,控制磁传感器阵列在x、y、z三个方向上,任意选择一个或两个或三个方向移动。
一种内窥镜胶囊体内位姿检测系统,包括内窥镜胶囊、磁传感器阵列、磁源位姿处理模块、运动设备;
所述内窥镜胶囊设有磁源;
所有磁传感器阵列,用于探测内窥镜胶囊的磁流密度值,并将获得的磁流密度值传送至磁源位姿处理模块;
所述磁源位姿处理模块,用于根据获得的磁流密度值,确定磁传感器阵列的移动位置,并以所述移动位置为移动目标,控制运动设备带动磁传感器阵列移动。
有益效果:
本发明通过实时获知磁源位置,相应地移动磁传感器阵列,以可移动的小型磁传感器阵列代替固定不动的大型磁传感器阵列,以减少传感器阵列的规模,从而减少非线性优化算法的计算量,并使磁源处于检测阵列可检测范围内的较好位置,能够使磁传感器阵列始终保持较高的检测精度。
附图说明
图1为磁源运动空间示意图。
图2为磁传感器阵列示意图。
图3为确定磁源位姿方法的流程图。
具体实施方式
下面结合附图并举两个实施例,对本发明进行详细描述。
具体实施方式一:
本发明提供了一种用于确定内窥镜胶囊体内位姿的检测系统和方法。
待检查者通过口服或肛门插入的方式,将内窥镜胶囊置于体内,保持仰卧、侧卧或俯卧姿态,并将磁传感器阵列置于腹部正下方。
如图1所示,设空间右手直角坐标系E的原点O位于待检查者腹部的几何中心,该坐标系的XOY平面与地面平行,Z轴垂直地面向上,并设待检测者腹部的宽度为2xb、长度为2yb、厚度为2zb。设待检测的内窥镜胶囊中内置有磁源δ,其磁矩为真空磁导率为μ0,其在某时刻t的位置坐标表示为(xδ(t),yδ(t),zδ(t))。由于内窥镜胶囊在人体腹部范围内运动,故其运动范围是关于原点O对称的长方体三维空间,即:对任意时刻t,满足:
-xb≤xδ(t)≤xb(1)
-yb≤yδ(t)≤yb(2)
-zb≤zδ(t)≤zb(3)
磁传感器阵列可用于检测内置磁源的内窥镜胶囊在人体内的位姿,其外观如图2所示,是由M×N个三轴磁流密度传感器组成的位于同一平面上的M行 N列(M≥2,N≥2,均为整数)矩形磁传感器阵列,其所在平面与坐标系E的 XOY平面始终保持平行。磁传感器阵列的列序数沿X轴正方向依次递增,行序数沿Y轴正方向依次递增。磁传感器阵列的行间距为λ,列间距为μ。
为实现磁传感器阵列对待检测磁源的位置跟踪,设有运动设备固连于磁传感器阵列,可实现磁传感器阵列沿X、Y、Z三轴方向的平移运动,且在运动过程中可实时获取磁传感器阵列在坐标系E下的三维位置坐标。
为便于描述磁传感器阵列的位置,以下以磁传感器阵列的几何中心C的位置描述磁传感器阵列的位置。设在某时刻t,磁传感器阵列的几何中心的位置坐标为(xC(t),yC(t),zC(t))。由于磁传感器阵列的检测范围覆盖磁源的运动范围,且位于待检测者腹部下方,因而有磁传感器阵列的运动范围为:在任意时刻t,满足
-xb≤xC(t)≤xb(4)
-yb≤yC(t)≤yb(5)
zC(t)<-zb(6)
以磁传感器阵列的几何中心C为参考点,根据磁传感器的行列间距,可推知位于第i行第j列的磁流密度传感器在t时刻的位置坐标(xij(t),yij(t),zij(t))如下式:
以下结合图3具体介绍确定磁源位姿的具体实现方法:
步骤1、获取各磁流密度传感器的磁流密度值
设所使用的磁流密度传感器的采样周期为ΔT,设n为采样周期数。对于初始时刻,n=0。
在第n个采样周期中,磁传感器阵列的第i行第j列的磁传感器所测三个正交方向的磁流密度值分别记为Bij,x(nΔT)、Bij,y(nΔT)、Bij,z(nΔT)。将该三个正交方向的磁流密度分量用矢量方式表示为
在第n个采样周期中,磁传感器阵列中的M×N个磁流密度传感器同时获取磁源在各磁传感器位置处的磁流密度值,记为B(nΔT),其中,
在第n个采样周期中,由运动设备可获得磁传感器阵列几何中心的位置坐标(xC(nΔT),yC(nΔT),zC(nΔT)),再由公式(7),可得阵列中各磁传感器的位置坐标 (xij(nΔT),yij(nΔT),zij(nΔT)),其中:
zij(nΔT)=zC(nΔT)(12)
其中,i∈[1,M],j∈[1,N]。
步骤2、获得磁源位姿
根据磁偶极子磁流密度模型计算磁源位姿。将系统第n个采样周期各传感器采样得到的磁流密度数据和各磁传感器的位置坐标代入磁偶极子磁流密度分布公式:
其中,为第i行第j列的磁传感器在第n个采样周期采得的磁流密度值,μ0为真空磁导率,为磁源的磁矩。为第n个采样周期,即nΔT时刻由磁源指向第i行第j列的磁传感器的三维空间矢量,
rij,t(nΔT)为矢量的模值,
综上,将各磁传感器测量到的磁流密度值B(nΔT)及磁传感器几何中心C的位置坐标(xC(nΔT),yC(nΔT),zC(nΔT))代入公式(10)~(15),形成方程组,再通过求解非线性优化问题获得磁源在第n个采样周期,即nΔT时刻的位姿,可得磁源位置 (xδ(nΔT),yδ(nΔT),zδ(nΔT))。所述非线性优化问题可使用“高斯-牛顿算法”或“林德伯格-马奎特算法”等求解。
步骤3、获得磁源位置正下方各点的磁流密度值,以最接近设定的磁流密度值的点作为磁传感器阵列几何中心的目标移动位置
为了提高磁传感器阵列在下一采样周期的测量精度,可以结合已获得的磁源位置计算磁源周围的磁流密度分布,在空间中选择磁传感器测量精度较高的位置作为磁传感器阵列的目标移动位置。
本发明提供方法A、方法B两种选取磁传感器阵列的目标移动位置的方法。
方法A根据最大磁流密度分量值选取目标移动位置
步骤3.1A、按设定步长距离将磁源位置正下方划分出K个点,利用磁偶极子磁流密度分布式,获得每个点三个正交方向上的磁流密度值
将步骤2中获得的磁源的磁矩和磁源的位姿代入磁源磁流密度公式,计算位于磁源正下方各点在三个正交方向上的磁流密度值。
根据测量精度要求,选取合适的步长距离h及测量步数上限K,计算位于磁源正下方距离磁源h至Kh范围内各点在第n个采样周期在三个正交方向上的磁流密度值。对于第k个点,即距离磁源kh处,其在三个正交方向上的磁流密度值为Bk,x(nΔT)、Bk,y(nΔT)、Bk,z(nΔT),其矢量表示为
其值可根据磁偶极子磁流密度公式计算如下:
k∈[1,K]。
其中,为位于磁源正下方的第k点处的磁流密度,μ0为真空磁导率,为磁源的磁矩,为第n个采样周期,即nΔT时刻由磁源指向磁源正下方 kh点的三维空间矢量,
rk(nΔT)为矢量的模值,
rk(nΔT)=kh(19)
步骤3.2A、遍历K个点,获得每个点在三个正交方向中最大磁流密度值
对磁源正下方第1~K点,分别求取三个正交方向中磁流密度最大的方向所对应的磁流密度值,即最大磁流密度值。
对于位于磁源正下方的第k点,其最大磁流密度值Bk,max(nΔT)为:
Bk,max(nΔT)=max(Bk,x(nΔT),Bk,y(nΔT),Bk,z(nΔT))(20)
步骤3.3A、设定参考磁流密度值
根据所用磁流密度传感器的测量精度特性,设定参考磁流密度值。
设磁传感器阵列所使用的磁流密度传感器在三个正交测量方向上具有相同的量程和测量精度特性,磁流密度传感器的量程上限为Bs。可根据具体测量需要设定一测量裕度参数η来选定参考磁流密度值Ba
Ba=ηBs(21)
其中,测量裕度参数η满足:
0<η<1(22)
步骤3.4A、分别求取各点的最大磁流密度值与参考磁流密度值的绝对差值,令绝对差值最小的值所对应的点作为目标移动位置
在步骤3.2A中获得的磁源正下方各点当中寻找一点,使该点的最大磁流密度值与步骤3.3A中选取的参考磁流密度值Ba最接近,从而保证磁传感器阵列在下一个采样周期中具有较高的测量精度,此点即为磁传感器阵列的目标移动位置。
对位于磁源正下方的第1~K点,选取最大磁流密度值与参考磁流密度值最接近的点作为目标移动位置。设磁传感器阵列的几何中心C的目标移动位置在点L,即磁源正下方第l点,该点所对应的步数l应满足:
{l||Bl,max(nΔT)-Ba|=min(|Bk,max(nΔT)-Ba|),k∈[1,K],l∈[1,K]}(23)
再通过由公式(23)计算获得的步数l推算目标移动位置点L的坐标,
(xL(nΔT),yL(nΔT),zL(nΔT))=(xδ(nΔT),yδ(nΔT),zδ(nΔT)-lh)(24)
其中,(xL(nΔT),yL(nΔT),zL(nΔT))为目标移动位置点L的坐标。
方法B根据磁流密度模值选取目标移动位置
步骤3.1B、按设定步长距离将磁源位置正下方划分出K个点,利用磁偶极子磁流密度分布式,获得每个点三个正交方向上的磁流密度值
将步骤2中获得的磁源的磁矩和磁源的位姿代入磁源磁流密度公式,计算位于磁源正下方各点在三个正交方向上的磁流密度值。
根据测量精度要求,选取合适的步长距离h及测量步数上限K,计算位于磁源正下方距离磁源h至Kh范围内各点在第n个采样周期在三个正交方向上的磁流密度值,对于第k个点,即距离磁源kh处,其在三个正交方向上的磁流密度值为Bk,x(nΔT)、Bk,y(nΔT)、Bk,z(nΔT),其矢量表示为
可根据磁偶极子磁流密度公式计算如下:
k∈[1,K]。
其中,为位于磁源正下方的第k点处的磁流密度,μ0为真空磁导率,为磁源的磁矩,为第n个采样周期,即nΔT时刻由磁源指向磁源正下方 kh点的三维空间矢量,
rk(nΔT)为矢量的模值,
rk(nΔT)=kh(28)
步骤3.2B、根据步骤3.1B中获得的各方向上的磁流密度值,遍历K个点,获得每个点磁流密度模值
对磁源正下方第1~K点,分别求取磁流密度模值。
对于位于磁源正下方的第k点,其磁流密度模值Bk(nΔT)为:
步骤3.3B、设定参考磁流密度值
根据所用磁流密度传感器的测量精度特性,设定参考磁流密度值。
设磁传感器阵列所使用的磁流密度传感器在三个正交测量方向上具有相同的量程和测量精度特性,量程上限为Bs。可根据具体测量需要设定一测量裕度参数η来选定参考磁流密度值Ba
Ba=ηBs(30)
其中,测量裕度参数η满足:
0<η<1(31)
步骤3.4B、分别求取各点的磁流密度模值与参考磁流密度值的绝对差值,令绝对差值最小的值所对应的点作为目标移动位置
在步骤3.2B中获得的磁源正下方第1~K点当中寻找一点,使该点的磁流密度模值与步骤3.3B中选取的参考磁流密度值Ba最接近,从而保证磁传感器阵列在下一个采样周期中具有较高的测量精度,此点即为磁传感器阵列的目标移动位置。
对位于磁源正下方的第1~K点,选取磁流密度模值与参考磁流密度值最接近的点作为目标移动位置。设磁传感器阵列的几何中心C的目标移动位置在点 L,即磁源正下方第l点,该点所对应的步数l应满足:
{l||Bl(nΔT)-Ba|=min(|Bk(nΔT)-Ba|),k∈[1,K],l∈[1,K]}(32)
再通过由公式(32)计算获得的步数l推算目标移动位置点L的坐标,
(xL(nΔT),yL(nΔT),zL(nΔT))=(xδ(nΔT),yδ(nΔT),zδ(nΔT)-lh)(33)
其中,(xL(nΔT),yL(nΔT),zL(nΔT))为目标移动位置点L的坐标。
步骤4、根据步骤3中获得的目标移动位置,控制磁传感器阵列向目标移动位置移动,返回步骤1,直至医生完成对消化道内壁的病变的诊察,停止工作。
在磁传感器阵列第n次采样开始后、第n+1次采样开始前,运动设备带动磁传感器阵列向目标移动位置移动。该运动使得在第n+1次采样开始时,磁传感器阵列的几何中心C的位置与目标移动位置重合,即:
(xC(ΔT+nΔT),yC(ΔT+nΔT),zC(ΔT+nΔT))=(xL(nΔT),yL(nΔT),zL(nΔT))(34)
磁传感器阵列的几何中心C的位置与目标移动位置重合之后,返回步骤1,直至医生完成对消化道内壁的病变的诊察,停止工作。
具体实施方式二:
本发明提供了一种用于确定内窥镜胶囊体内位姿的检测系统和方法。
待检查者通过口服或肛门插入的方式,将内窥镜胶囊置于体内,保持仰卧、侧卧或俯卧姿态,并将磁传感器阵列置于腹部正下方。
如图1所示,设空间右手直角坐标系E的原点O位于待检查者腹部的几何中心,该坐标系的XOY平面与地面平行,Z轴垂直地面向上,并设待检测者腹部的宽度为2xb、长度为2yb、厚度为2zb。设待检测的内窥镜胶囊中内置有磁源δ,其磁矩为真空磁导率为μ0,其在某时刻t的位置坐标表示为(xδ(t),yδ(t),zδ(t))。由于内窥镜胶囊在人体腹部范围内运动,故其运动范围是关于原点O对称的长方体三维空间,即:对任意时刻t,满足:
-xb≤xδ(t)≤xb(35)
-yb≤yδ(t)≤yb(36)
-zb≤zδ(t)≤zb(37)
磁传感器阵列可用于检测内置磁源的内窥镜胶囊在人体内的位姿,其外观如图2所示,是由M×N个三轴磁流密度传感器组成的位于同一平面上的M行 N列(M≥2,N≥2,均为整数)矩形磁传感器阵列,其所在平面与坐标系E的 XOY平面始终保持平行。磁传感器阵列的列序数沿X轴正方向依次递增,行序数沿Y轴正方向依次递增。磁传感器阵列的行间距为λ,列间距为μ。
为实现磁传感器阵列对待检测磁源的位置跟踪,设有运动设备固连于磁传感器阵列,可实现磁传感器阵列沿Z轴方向的平移运动,且在运动过程中可实时获取磁传感器阵列在坐标系E下的Z轴方向位置坐标。
为便于描述磁传感器阵列的位置,以下以磁传感器阵列的几何中心C的位置描述磁传感器阵列的位置。设在某时刻t,磁传感器阵列的几何中心的位置坐标为(xC(t),yC(t),zC(t))。由于磁传感器阵列只在Z轴方向做平移运动,且位于待检测者腹部下方,因而有磁传感器阵列的运动范围为:在任意时刻t,满足
xC(t)=0(38)
yC(t)=0(39)
zC(t)<-zb(40)
以磁传感器阵列的几何中心C为起始点,根据磁传感器的行列间距,可推知位于第i行第j列的磁传感器在t时刻的位置坐标(xij(t),yij(t),zij(t))如下式:
以下结合图3具体介绍确定磁源位姿的具体实现方法:
步骤1、获取各磁流密度传感器的磁流密度值
设所使用的磁流密度传感器的采样周期为ΔT,设n为采样周期数。对于初始时刻,n=0。
在第n个采样周期中,磁传感器阵列的第i行第j列的磁传感器所测三个正交方向的磁流密度值分别记为Bij,x(nΔT)、Bij,y(nΔT)、Bij,z(nΔT)。将该三个正交方向的磁流密度分量用矢量方式表示为
在第n个采样周期中,磁传感器阵列中的M×N个磁流密度传感器同时获取磁源在各磁传感器位置处的磁流密度值,记为B(nΔT),其中,
在第n个采样周期中,由运动设备可获得磁传感器阵列几何中心的位置坐标(xC(nΔT),yC(nΔT),zC(nΔT)),再由公式(41),可得阵列中各磁传感器的位置坐标(xij(nΔT),yij(nΔT),zij(nΔT)),其中:
zij(nΔT)=zC(nΔT)(46)
其中,i∈[1,M],j∈[1,N]。
步骤2、获得磁源位姿
根据磁偶极子磁流密度模型计算磁源位姿。将系统第n个采样周期各传感器采样得到的磁流密度数据和各磁传感器的位置坐标代入磁偶极子磁流密度分布公式:
其中,为第i行第j列的磁传感器在第n个采样周期采得的磁流密度值,μ0为真空磁导率,为磁源的磁矩。为第n个采样周期,即nΔT时刻由磁源指向第i行第j列的磁传感器的三维空间矢量,
rij,t(nΔT)为矢量的模值,
综上,将各磁传感器测量到的磁流密度值B(nΔT)及磁传感器几何中心C的位置坐标(xC(nΔT),yC(nΔT),zC(nΔT))代入公式(44)~(49),形成方程组,再通过求解非线性优化问题获得磁源在第n个采样周期,即nΔT时刻的位姿,可得磁源位置 (xδ(nΔT),yδ(nΔT),zδ(nΔT))。所述非线性优化问题可使用“高斯-牛顿算法”或“林德伯格-马奎特算法”等求解。
步骤3、获得磁源位置正下方各点的磁流密度值,以最接近设定的磁流密度值的点作为磁传感器阵列的目标移动位置
为了提高磁传感器阵列在下一采样周期的测量精度,可以结合已获得的磁源位置计算磁源周围的磁流密度分布,在空间中选择磁传感器测量精度较高的位置作为磁传感器阵列的目标移动位置。
本发明提供方法A、方法B两种选取磁传感器阵列的目标移动位置的方法。
方法A根据最大磁流密度分量值选取目标移动位置
步骤3.1A、按设定步长距离将磁源位置正下方划分出K个点,利用磁偶极子磁流密度分布式,获得每个点三个正交方向上的磁流密度值
将步骤2中获得的磁源的磁矩和磁源的位姿代入磁源磁流密度公式,计算位于磁源正下方各点在三个正交方向上的磁流密度值。
根据测量精度要求,选取合适的步长距离h及测量步数上限K,计算位于磁源正下方距离磁源h至Kh范围内各点在第n个采样周期在三个正交方向上的磁流密度值,对于第k个点,即距离磁源kh处,其在三个正交方向上的磁流密度值为Bk,x(nΔT)、Bk,y(nΔT)、Bk,z(nΔT),其矢量表示为
可根据磁偶极子磁流密度公式计算如下:
k∈[1,K]。
其中,为位于磁源正下方的第k点处的磁流密度,μ0为真空磁导率,为磁源的磁矩,为第n个采样周期,即nΔT时刻由磁源指向磁源正下方 kh点的三维空间矢量,
rk(nΔT)为矢量的模值,
rk(nΔT)=kh(53)
步骤3.2A、遍历K个点,获得每个点在三个正交方向中最大磁流密度值对磁源正下方第1~K点,分别求取三个正交方向中磁流密度最大的方向所对应的磁流密度值。
对于位于磁源正下方的第k点,其最大磁流密度值Bk,max(nΔT)为:
Bk,max(nΔT)=max(Bk,x(nΔT),Bk,y(nΔT),Bk,z(nΔT))(54)
步骤3.3A、设定参考磁流密度值
根据所用磁流密度传感器的测量精度特性,选取参考磁流密度值。
设磁传感器阵列所使用的磁流密度传感器在三个正交测量方向上具有相同的量程和测量精度特性,量程上限为Bs。可根据具体测量需要设定一测量裕度参数η,来选定参考磁流密度值Ba
Ba=ηBs(55)
其中,测量裕度参数η满足:
0<η<1(56)
步骤3.4A、分别求取各点的最大磁流密度值与参考磁流密度值的绝对差值,令绝对差值最小的值所对应的点作为目标移动位置
在步骤3.2A中获得的磁源正下方第1~K点当中寻找一点,使该点的最大磁流密度值与步骤3.3A中选取的参考磁流密度值最接近,从而保证磁传感器阵列在下一个采样周期中具有较高的测量精度,此点即为磁传感器阵列的目标移动位置。
设磁传感器阵列的目标移动位置在点L,其坐标为(xL(nΔT),yL(nΔT),zL(nΔT)),并设
(xL(nΔT),yL(nΔT),zL(nΔT))=(xδ(nΔT),yδ(nΔT),zδ(nΔT)-lh)(57)
其中l为目标移动位置L与磁源在Z轴方向的距离以步长h计算的步数,为实现最大磁流密度值与参考磁流密度值最接近,该步数l满足:
{l||Bl,max(nΔT)-Ba|=min(|Bk,max(nΔT)-Ba|),k∈[1,K],l∈[1,K]}(58)
通过求解步数l即获得磁传感器阵列的目标移动位置点L。由于磁传感器阵列只能沿Z轴移动,因此,磁传感器阵列几何中心C的目标移动位置坐标为 (0,0,zL(nΔT))。
方法B根据磁流密度模值选取目标移动位置
步骤3.1B、按设定步长距离将磁源位置正下方划分出K个点,利用磁偶极子磁流密度分布式,获得每个点三个正交方向上的磁流密度值
将步骤2中获得的磁源的磁矩和磁源的位姿代入磁源磁流密度公式,计算位于磁源正下方各点在三个正交方向上的磁流密度值。
根据测量精度要求,选取合适的步长距离h及测量步数上限K,计算位于磁源正下方距离磁源h至Kh范围内各点在第n个采样周期在三个正交方向上的磁流密度值,对于第k个点,即距离磁源kh处,其在三个正交方向上的磁流密度值为Bk,x(nΔT)、Bk,y(nΔT)、Bk,z(nΔT),其矢量表示为
可根据磁偶极子磁流密度公式计算如下:
k∈[1,K]。
其中,为位于磁源正下方的第k点处的磁流密度,μ0为真空磁导率,为磁源的磁矩,为第n个采样周期,即nΔT时刻由磁源指向磁源正下方 kh点的三维空间矢量,
rk(nΔT)为矢量的模值,
rk(nΔT)=kh(62)
步骤3.2B、根据步骤3.1B中获得的各方向上的磁流密度值,遍历K个点,获得每个点磁流密度模值
对磁源正下方第1~K点,分别求取磁流密度模值。
对于位于磁源正下方的第k点,其磁流密度模值Bk(nΔT)为:
步骤3.3B、设定参考磁流密度值
根据所用磁流密度传感器的测量精度特性,设定参考磁流密度值。
设磁传感器阵列所使用的磁流密度传感器在三个正交测量方向上具有相同的量程和测量精度特性,量程上限为Bs。可根据具体测量需要设定一测量裕度参数η来选定参考磁流密度值Ba
Ba=ηBs(64)
其中,测量裕度参数η满足:
0<η<1(65)
步骤3.4B、分别求取各点的磁流密度模值与参考磁流密度值的绝对差值,令绝对差值最小的值所对应的点作为目标移动位置
在步骤3.2B中获得的磁源正下方第1~K点当中寻找一点,使该点的磁流密度模值与步骤3.3B中选取的参考磁流密度值最接近,从而保证磁传感器阵列在下一个采样周期中具有较高的测量精度,此点即为磁传感器阵列的目标移动位置。
设磁传感器阵列的目标移动位置在点L,其坐标为(xL(nΔT),yL(nΔT),zL(nΔT)),并设
(xL(nΔT),yL(nΔT),zL(nΔT))=(xδ(nΔT),yδ(nΔT),zδ(nΔT)-lh)(66)
其中l为目标移动位置L与磁源在Z轴方向的距离以步长h计算的步数,为实现磁流密度模值与参考磁流密度值最接近,该步数l满足:
{l||Bl(nΔT)-Ba|=min(|Bk(nΔT)-Ba|),k∈[1,K],l∈[1,K]}(67)
通过求解步数l即获得磁传感器阵列的目标移动位置点L。由于磁传感器阵列只能沿Z轴移动,因此,磁传感器阵列几何中心C的目标移动位置坐标为 (0,0,zL(nΔT))。
步骤4、根据步骤3中获得的目标移动位置,控制磁传感器阵列向目标移动位置移动,返回步骤1,直至医生完成对消化道内壁的病变的诊察,停止工作
在磁传感器阵列第n次采样开始后、第n+1次采样开始前,运动设备带动磁传感器阵列向目标移动位置移动。该运动使得在第n+1次采样开始时,磁传感器阵列的位置与目标移动位置重合,即:
(xC(ΔT+nΔT),yC(ΔT+nΔT),zC(ΔT+nΔT))=(0,0,zL(nΔT))(68)
磁传感器阵列的位置与目标移动位置重合之后,返回步骤1,直至医生完成对消化道内壁的病变的诊察,停止工作。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (8)

1.一种用于确定内窥镜胶囊体内位姿的方法,采用M×N个三轴磁流密度传感器组成的磁传感器阵列进行体外探测;内窥镜胶囊内设有磁源,并将内窥镜胶囊置于体内;其特征在于:将磁传感器阵列与运动设备固连,通过磁传感器阵列实时获得体内磁源的位姿,并根据所述位姿,通过控制运动设备,实现磁传感器阵列与磁源的跟随。
2.如权利要求1所述的一种用于确定内窥镜胶囊体内位姿的方法,其特征在于,其具体实现方法为:
步骤一、获取各磁流密度传感器的磁流密度值
在任意采样时刻,第i行第j列的磁流密度传感器的三个正交方向的磁流密度值由当前位置的磁流密度传感器采集获得;其中,i∈[1,M],j∈[1,N];
步骤二、获得磁源位姿
将步骤一中获得各磁流密度传感器的磁流密度值、磁源指向对应磁传感器的三维空间矢量、真空磁导率和磁矩代入磁偶极子磁流密度分布式,获得磁源位姿;
步骤三、获得从磁源位置垂直指向磁传感器阵列的方向上各点的磁流密度值,以最接近设定的参考磁流密度值的点作为磁传感器阵列的目标移动位置;
步骤四、根据步骤三中获得的目标移动位置,控制运动设备带动磁传感器阵列向目标移动位置移动。
3.如权利要求2所述的一种用于确定内窥镜胶囊体内位姿的方法,其特征在于,所述步骤三中获得目标移动位置的具体方法为:
步骤3.1A、按设定步长距离在由磁源位置垂直指向磁传感器阵列的方向上划分出K个点,利用磁偶极子磁流密度分布式,获得每个点三个正交方向上的磁流密度值;
步骤3.2A、遍历K个点,获得每个点在三个正交方向中最大磁流密度值;
步骤3.3A、设置参考磁流密度值;
步骤3.4A、分别求取各点的最大磁流密度值与参考磁流密度值的绝对差值,令绝对差值最小的值所对应的点作为目标移动位置。
4.如权利要求3所述的一种用于确定内窥镜胶囊体内位姿的方法,其特征在于,步骤3.3A中设定参考磁流密度值的具体方法为:
设定一测量裕度参数η,令参考磁流密度值Ba=ηBs,其中Bs为量程上限。
5.如权利要求2所述的一种用于确定内窥镜胶囊体内位姿的方法,其特征在于,所述步骤三中获得目标移动位置的具体方法为:
步骤3.1B、按设定步长距离在由磁源位置垂直指向磁传感器阵列的方向上划分出K个点,利用磁偶极子磁流密度分布式,获得每个点三个正交方向上的磁流密度值;
步骤3.2B、根据步骤3.1B中获得的各方向上的磁流密度值,遍历K个点,获得每个点磁流密度模值;
步骤3.3B、设定参考磁流密度值;
步骤3.4B、分别求取各点的磁流密度模值与参考磁流密度值的绝对差值,令绝对差值最小的值所对应的点作为目标移动位置。
6.如权利要求5所述的一种用于确定内窥镜胶囊体内位姿的方法,其特征在于,所述步骤3.3B中设定参考磁流密度值的具体方法为:
设定一测量裕度参数η,令参考磁流密度值Ba=ηBs,其中Bs为磁流密度传感器的量程上限。
7.如权利要求2或3或4或5或6所述的一种用于确定内窥镜胶囊体内位姿的方法,其特征在于,所述步骤四中,根据运动设备的实际情况,以目标移动位置为目标,控制磁传感器阵列在x、y、z三个方向上,任意选择一个或两个或三个方向移动。
8.一种内窥镜胶囊体内位姿检测系统,其特征在于,包括内窥镜胶囊、磁传感器阵列、磁源位姿处理模块、运动设备;
所述内窥镜胶囊设有磁源;
所有磁传感器阵列,用于探测内窥镜胶囊的磁流密度值,并将获得的磁流密度值传送至磁源位姿处理模块;
所述磁源位姿处理模块,用于根据获得的磁流密度值,确定磁传感器阵列的移动位置,并以所述移动位置为移动目标,控制运动设备带动磁传感器阵列移动。
CN201711232178.9A 2017-11-30 2017-11-30 一种用于确定内窥镜胶囊体内位姿的检测系统和方法 Active CN108186017B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711232178.9A CN108186017B (zh) 2017-11-30 2017-11-30 一种用于确定内窥镜胶囊体内位姿的检测系统和方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711232178.9A CN108186017B (zh) 2017-11-30 2017-11-30 一种用于确定内窥镜胶囊体内位姿的检测系统和方法

Publications (2)

Publication Number Publication Date
CN108186017A true CN108186017A (zh) 2018-06-22
CN108186017B CN108186017B (zh) 2020-10-02

Family

ID=62573534

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711232178.9A Active CN108186017B (zh) 2017-11-30 2017-11-30 一种用于确定内窥镜胶囊体内位姿的检测系统和方法

Country Status (1)

Country Link
CN (1) CN108186017B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109444773A (zh) * 2018-10-12 2019-03-08 北京理工大学 一种固连外部磁体和磁传感器阵列的磁源检测装置
CN111390903A (zh) * 2020-03-13 2020-07-10 北京理工大学 一种磁控机器人交互距离监控装置和方法
WO2021208849A1 (zh) * 2020-04-13 2021-10-21 北京理工大学 一种建立有效磁连接的方法和装置

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5762064A (en) * 1995-01-23 1998-06-09 Northrop Grumman Corporation Medical magnetic positioning system and method for determining the position of a magnetic probe
US20030195412A1 (en) * 2001-01-29 2003-10-16 Gillies George T. Catheter navigation within an MR imaging device
EP1545299A2 (en) * 2002-08-08 2005-06-29 University of Lausanne System and method for monitoring and stimulating gastro-intestinal motility
CN1956675A (zh) * 2004-05-26 2007-05-02 奥林巴斯株式会社 位置关系检测装置以及位置关系检测系统
CN101080198A (zh) * 2004-12-17 2007-11-28 奥林巴斯株式会社 位置检测系统、引导系统、位置检测方法、医用装置、和医用磁感应及位置检测系统
EP1803394A3 (en) * 2005-12-30 2008-03-12 DePuy Products, Inc. Method of determining a position of a magnetic source
CN101297756A (zh) * 2008-06-19 2008-11-05 大连理工大学 磁场与视觉相结合的医疗微型机器人体内姿态定位方法
CN101950176A (zh) * 2010-09-02 2011-01-19 北京理工大学 一种机器人自主进行zmp标定的方法
CN101978242A (zh) * 2008-03-17 2011-02-16 三菱电机株式会社 原点位置信号检测器
EP2594197A1 (en) * 2011-11-21 2013-05-22 Technische Universität München Tracking system and method
CN103222841A (zh) * 2013-04-10 2013-07-31 深圳市资福技术有限公司 胶囊内窥镜体内运行速度的控制系统及控制方法
WO2016098818A1 (ja) * 2014-12-18 2016-06-23 株式会社パイオラックス カプセル内視鏡及びカプセル内視鏡検査方法並びにカプセル内視鏡検査装置
CN105960261A (zh) * 2013-12-04 2016-09-21 奥巴隆治疗公司 用于定位和/或表征胃内设备的系统和方法

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5762064A (en) * 1995-01-23 1998-06-09 Northrop Grumman Corporation Medical magnetic positioning system and method for determining the position of a magnetic probe
US20030195412A1 (en) * 2001-01-29 2003-10-16 Gillies George T. Catheter navigation within an MR imaging device
EP1545299A2 (en) * 2002-08-08 2005-06-29 University of Lausanne System and method for monitoring and stimulating gastro-intestinal motility
CN1956675A (zh) * 2004-05-26 2007-05-02 奥林巴斯株式会社 位置关系检测装置以及位置关系检测系统
CN101080198A (zh) * 2004-12-17 2007-11-28 奥林巴斯株式会社 位置检测系统、引导系统、位置检测方法、医用装置、和医用磁感应及位置检测系统
EP1803394A3 (en) * 2005-12-30 2008-03-12 DePuy Products, Inc. Method of determining a position of a magnetic source
CN101978242A (zh) * 2008-03-17 2011-02-16 三菱电机株式会社 原点位置信号检测器
CN101297756A (zh) * 2008-06-19 2008-11-05 大连理工大学 磁场与视觉相结合的医疗微型机器人体内姿态定位方法
CN101950176A (zh) * 2010-09-02 2011-01-19 北京理工大学 一种机器人自主进行zmp标定的方法
EP2594197A1 (en) * 2011-11-21 2013-05-22 Technische Universität München Tracking system and method
CN103222841A (zh) * 2013-04-10 2013-07-31 深圳市资福技术有限公司 胶囊内窥镜体内运行速度的控制系统及控制方法
CN105960261A (zh) * 2013-12-04 2016-09-21 奥巴隆治疗公司 用于定位和/或表征胃内设备的系统和方法
WO2016098818A1 (ja) * 2014-12-18 2016-06-23 株式会社パイオラックス カプセル内視鏡及びカプセル内視鏡検査方法並びにカプセル内視鏡検査装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
CHAO HU等: ""Locating Intra-Body Capsule Object by Three-Magnet Sensing System"", 《IEEE SENSORS JOURNAL》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109444773A (zh) * 2018-10-12 2019-03-08 北京理工大学 一种固连外部磁体和磁传感器阵列的磁源检测装置
WO2020073540A1 (zh) * 2018-10-12 2020-04-16 北京理工大学 一种固连外部磁体和磁传感器阵列的磁源检测装置
CN109444773B (zh) * 2018-10-12 2020-10-27 北京理工大学 一种固连外部磁体和磁传感器阵列的磁源检测装置
CN111390903A (zh) * 2020-03-13 2020-07-10 北京理工大学 一种磁控机器人交互距离监控装置和方法
WO2021208849A1 (zh) * 2020-04-13 2021-10-21 北京理工大学 一种建立有效磁连接的方法和装置

Also Published As

Publication number Publication date
CN108186017B (zh) 2020-10-02

Similar Documents

Publication Publication Date Title
CN100594840C (zh) 一种跟踪体内微型装置的方法
CN101361660B (zh) 一种多磁性目标的定位方法及定位系统
JP4054104B2 (ja) 内視鏡画像処理装置
KR100954650B1 (ko) 캡슐형 의료 장치
CN108186017B (zh) 一种用于确定内窥镜胶囊体内位姿的检测系统和方法
Yim et al. 3-D localization method for a magnetically actuated soft capsule endoscope and its applications
CN105919595B (zh) 用于跟踪运动物体体内具有磁信号的微型装置的系统和方法
CN108289598A (zh) 描绘系统
JP2013516219A5 (ja) 位置参照センサを使用した、動く器官における動きの補償
JP2022547189A (ja) デジタル磁力計を用いた可撓性カテーテルの磁気追跡システムおよび方法
Iakovidis et al. Deep endoscopic visual measurements
CN211633195U (zh) 胶囊内窥镜的磁定位系统
CN107374574B (zh) 一种用于确定内窥镜胶囊体内位姿的装置
CN200970224Y (zh) 医用内窥镜本体三维定位系统
CN104739418A (zh) 一种基于立体视觉的呼吸门控系统及控制方法
CN1957834A (zh) 医用内窥镜本体三维定位系统和方法
CN108042094B (zh) 无线胶囊内窥镜5自由度的定位系统及其定位方法
Liu et al. Capsule endoscope localization based on computer vision technique
Wang et al. 3-D electromagnetic position estimation system using high-magnetic-permeability metal for continuum medical robots
KR20110130968A (ko) 의료 영상 장치용 3축 움직임 추적 장치 및 이를 이용한 의료 영상 보정 방법
Song et al. Real time algorithm for magnet's localization in capsule endoscope
CN101632570A (zh) 医用内窥镜标定方法
Wang et al. Dynamic tracking for microrobot with active magnetic sensor array
CN115886692B (zh) 磁控悬浮胶囊机器人的实时定位方法、系统及存储介质
Xu et al. A review of magnetic sensor-based positioning techniques for capsule endoscopy

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
GR01 Patent grant
GR01 Patent grant