CN113288008A - 一种磁性胶囊内窥镜全姿态测定方法 - Google Patents

一种磁性胶囊内窥镜全姿态测定方法 Download PDF

Info

Publication number
CN113288008A
CN113288008A CN202110570007.7A CN202110570007A CN113288008A CN 113288008 A CN113288008 A CN 113288008A CN 202110570007 A CN202110570007 A CN 202110570007A CN 113288008 A CN113288008 A CN 113288008A
Authority
CN
China
Prior art keywords
capsule endoscope
permanent magnet
magnetic
magnetic capsule
small
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
CN202110570007.7A
Other languages
English (en)
Other versions
CN113288008B (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.)
Hubei University
Original Assignee
Hubei University
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 Hubei University filed Critical Hubei University
Priority to CN202110570007.7A priority Critical patent/CN113288008B/zh
Priority to JP2021102594A priority patent/JP7270284B2/ja
Publication of CN113288008A publication Critical patent/CN113288008A/zh
Application granted granted Critical
Publication of CN113288008B publication Critical patent/CN113288008B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00—Instruments 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/04—Instruments 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/041—Capsule endoscopes for imaging
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00—Instruments 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/00131—Accessories for endoscopes
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00—Instruments 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/00147—Holding or positioning arrangements
    • A61B1/00158—Holding or positioning arrangements using magnetic field
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00—Instruments 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/04—Instruments 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/045—Control thereof
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B1/00—Instruments 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/273—Instruments 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 for the upper alimentary canal, e.g. oesophagoscopes, gastroscopes
    • A61B1/2736—Gastroscopes

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Biomedical Technology (AREA)
  • Medical Informatics (AREA)
  • Optics & Photonics (AREA)
  • Pathology (AREA)
  • Radiology & Medical Imaging (AREA)
  • Biophysics (AREA)
  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Molecular Biology (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Gastroenterology & Hepatology (AREA)
  • Endoscopes (AREA)

Abstract

本发明公开了一种磁性胶囊内窥镜全姿态测定方法，所述胶囊内窥镜内设置的永磁体是径向充磁的永磁体。首先预估磁性胶囊内窥镜的初始姿态；然后调整外部大磁体的姿态，使外部大磁体的姿态与所述磁性胶囊内窥镜的初始姿态一致；接着利用外部大磁体控制所述磁性胶囊内窥镜绕其自身轴向中心轴旋转，计算旋转后磁性胶囊内窥镜内永磁体的当前径向磁化方向单位向量
Figure DDA0003082299490000011
最后计算磁性胶囊内窥镜内永磁体的轴向方向单位向量
Figure DDA0003082299490000012
即完全确定磁性胶囊内窥镜的当前姿态。本发明操作方法简单，没有累计误差，可以解决实际应用中需要同时实现胶囊主动运动与胶囊定位的问题。

Description

一种磁性胶囊内窥镜全姿态测定方法
技术领域
本发明涉及医疗设备技术领域，特别涉及一种磁性胶囊内窥镜全姿态测定方法。
背景技术
无线胶囊内窥镜(以后简称胶囊镜)，以吞服的方式对人体消化道进行医疗诊查，是一种非侵入式医检方式，是内窥镜发展史上的一场革命与未来发展方向。与传统的医用内窥镜相比，胶囊镜具有无创无痛、操作方便、小巧安全、无交叉感染等诸多优点，极大地减轻了患者的痛苦，拓展了医生的检查视野，填补了胃镜、肠镜检查的盲区，尤其对小肠可疑性病变具有很高的诊断价值，具有巨大的市场应用价值。
在胶囊镜的临床使用中，快速、精确、完整地测定胶囊镜空间位置和姿态的全部参数的是最为关键的问题之一。完整地获知胶囊镜在人体消化道内的准确位置和姿态信息能够带来以下技术优势：帮助医生判断病灶组织图片的准确拍摄位置和角度，从而对病症做出准确的判断；为主动控制胶囊镜的运动提供必要的位置姿态数据，从而为医生自主控制胶囊镜进行全方位的检查拍摄或实现指定位置或路线的检查、施药等医疗目的，提供重要的技术支撑。
目前，胶囊镜的空间姿态全参数的快速准确测定还存在着困难。现有的胶囊镜位姿测定方法中，采用在胶囊镜中放置小型永磁体的静磁定位方式，具有无需电源、实现简单、对人体无损伤的特点，很适合胶囊镜这种近距离、高精度的定位需求。
现有的基于静磁的胶囊镜位姿测定方法，是将永磁体作为磁源、利用磁偶极子模型及其修正模型，采用非线性优化算法计算胶囊的6个位姿参数(3个位置参数和3个姿态参数)。具有较好的磁定位精度；但所述的3个姿态参数(m，n，p)具有约束关系(m2+n2+p2＝1)，因此实际上只能确定二维姿态参数，无法确定全部三维姿态参数，即无法获得胶囊镜姿态参数中的横滚角。原因是，现有的胶囊镜设置的内部永磁体一般是轴向磁性的圆环状磁体，且磁体中心轴设置为与胶囊镜中心轴同向，当胶囊镜绕自身轴向旋转时，该轴向磁性永磁体的磁场方向并不发生改变，因此无法根据磁场变换检测出胶囊镜的姿态变化(即横滚角变化)。
虽然有些算法也可以实现矩形永磁体的六维磁定位，但由于矩形永磁体的形状因素，它并不能很好的与胶囊镜相组合，因而并不适合用于胶囊镜。同时，胶囊镜工作环境对于外部是完全视觉隔离的，使得大部分依赖视频识别姿态的测量手段无效。
另一类现有的胶囊镜位姿测定方法采用三轴角速度数据参与位姿求解。但该类方法存在累计误差，即：角速度仪的数据在换算成角度的时候，存在一个积分累计误差，并且该累计误差会随着时间的推移越来越大，导致测量误差较大。虽然现有技术中可使用三轴地磁传感器测出地磁向量对角度进行校准，以消除累计误差，然而由于主动式胶囊的使用环境中，存在较强的驱动胶囊运动的外部磁场，因而地磁传感器无法使用。
因此，如何快速、完整地测定胶囊镜的全部姿态参数，是本领域技术人员亟待解决的技术问题。
发明内容
为了解决上述技术问题，本发明提供了一种磁性胶囊内窥镜全姿态测定方法，能够简单、准确、完整地测定胶囊内窥镜的全部姿态参数和位置参数。
本发明提供的一种磁性胶囊内窥镜全姿态测定方法，采用磁性胶囊内窥镜，所述胶囊内窥镜内设置的永磁体是径向充磁的小永磁体；所述小永磁体是圆柱状或圆环状，固定设置于所述磁性胶囊内窥镜的内部或固定于圆环形磁性胶囊内窥镜外壳壁上，且所述小永磁体的轴向方向与所述磁性胶囊内窥镜的轴向方向一致；所述胶囊内窥镜外部设置有大永磁体，所述大永磁体是径向充磁的圆柱状强永磁铁；
所述方法包括以下步骤：
步骤1：估计磁性胶囊内窥镜的初始姿态，确定所述磁性胶囊内窥镜内小永磁体的径向磁化方向单位向量
Figure BDA0003082299470000021
和轴向方向单位向量
Figure BDA0003082299470000022
具体实现包括以下子步骤：
步骤1.1：计算所述小永磁体的径向磁化方向单位向量
Figure BDA0003082299470000023
步骤1.2：根据所述小永磁体的径向磁化方向向量，利用外部大永磁体控制所述磁性胶囊内窥镜旋转；
步骤1.3：计算所述小永磁体旋转后的径向磁化方向单位向量
Figure BDA0003082299470000024
步骤1.4：由
Figure BDA0003082299470000031
和
Figure BDA0003082299470000032
计算所述磁性胶囊内窥镜的预估轴向方向单位向量
Figure BDA0003082299470000033
步骤2：调整外部大永磁体的姿态，使外部大永磁体的姿态与所述磁性胶囊内窥镜的当前姿态一致；
步骤3：利用外部大永磁体控制所述磁性胶囊内窥镜绕其自身轴向中心轴旋转；
步骤4：计算旋转后的所述磁性胶囊内窥镜内小永磁体的当前径向磁化方向单位向量
Figure BDA0003082299470000034
步骤5：计算所述磁性胶囊内窥镜的轴向方向单位向量
Figure BDA0003082299470000035
Figure BDA0003082299470000036
即完全确定所述胶囊内窥镜的当前姿态。
本发明可以解决现有的根据角速度数据计算姿态角度方法中的积分累计误差问题，以及解决现有静磁定位方法不能完整测定胶囊内窥镜全部姿态参数的问题，主要解决不能测定胶囊内窥镜绕自身轴向旋转角度的问题。本发明能够完整地测定胶囊内窥镜的全部姿态参数；且操作方法简单，没有累计误差；同时，该方法中的外部永磁体可以同时用于对胶囊内窥镜的主动控制，可很好的解决实际应用中需要同时实现胶囊内窥镜主动运动与胶囊内窥镜定位的问题。
附图说明
图1为本发明实施例的胶囊镜内永磁体与外部大磁体、人体及磁传感器阵列的空间关系示意图；
图2为本发明实施的方法流程图；
图3为本发明实施例的外部大磁体控制磁性胶囊内窥镜旋转原理图；
图4为本发明实施例的磁传感器阵列与OXYZ坐标系、以及小永磁体旋转方向的空间关系示意图。
具体实施方式
为了便于本领域普通技术人员理解和实施本发明，下面结合附图及实施例对本发明作进一步的详细描述，应当理解，此处所描述的实施示例仅用于说明和解释本发明，并不用于限定本发明。
本发明提供的一种磁性胶囊内窥镜全姿态测定方法，采用磁性胶囊内窥镜；胶囊内窥镜内设置的永磁体是径向充磁的小永磁体；小永磁体是圆柱状或圆环状，固定设置于磁性胶囊内窥镜的内部或固定于圆环形磁性胶囊内窥镜外壳壁上，且小永磁体的轴向方向与磁性胶囊内窥镜的轴向方向一致；胶囊内窥镜外部设置有大永磁体，大永磁体是径向充磁的圆柱状强永磁铁，如图1所示。
请见图2，本发明提供的一种磁性胶囊内窥镜全姿态测定方法，具体包括以下步骤：
步骤1：估计磁性胶囊内窥镜的初始姿态，确定磁性胶囊内窥镜内小永磁体的径向磁化方向单位向量
Figure BDA0003082299470000041
和轴向方向单位向量
Figure BDA0003082299470000042
具体实现包括以下子步骤：
步骤1.1：计算小永磁体的径向磁化方向单位向量
Figure BDA0003082299470000043
具体过程为：
(1)通过磁传感器阵列，检测得到由所述小磁体产生的当前磁感应强度
Figure BDA0003082299470000044
其中，N(≥5)是磁传感器阵列中三轴磁性传感器的数量。如图4所示，以传感器阵列所在平面为XOY平面，建立三维直角坐标系OXYZ。第n个磁传感器处的磁感应强度当前值记作
Figure BDA0003082299470000045
其中，B0，nx、B0，ny、B0，nz分别表示第n个磁传感器在坐标系OXYZ中x轴、y轴和z轴三个方向上的磁感应强度分量。磁传感器阵列固定于所述人体外部(如人体下方)，如图1所示。
(2)根据(1)中检测到的磁感应强度
Figure BDA0003082299470000046
利用磁偶极子模型的方法，将小磁体视作点源，计算小磁体的磁化方向的单位向量
Figure BDA0003082299470000047
(即m0 2+n0 2+p0 2＝1)。具体方法为：
①建立目标函数：
Figure BDA0003082299470000048
其中，
Figure BDA0003082299470000049
b0，n＝B0，nxyn-B0， nyxn，
Figure BDA00030822994700000410
(xn，yn，zn)是第n个磁传感器在OXYZ坐标系中的位置坐标，(a，b，c)是小磁体在OXYZ坐标系中的位置坐标，m0′＝m0/p0，n0′＝n0/p0。
②利用非线性优化算法求解上述目标函数，求出小磁体(即磁性胶囊内窥镜)的姿态参数m0′和n0′。
③根据下式计算小磁体的磁化方向单位向量
Figure BDA0003082299470000051
Figure BDA0003082299470000052
m0＝m0′p0
n0＝n0′p0
步骤1.2：根据小磁体的径向磁化方向向量，利用外部大磁体控制磁性胶囊内窥镜旋转；
本实施例中，外部大磁体控制磁性胶囊内窥镜旋转的方式为：首先放置外部大磁体，使大磁体的径向磁化方向与小磁体的径向磁化方向(即向量
Figure BDA00030822994700000510
)同向，如图3(a)所示，然后控制外部大磁体绕自身轴向中心轴逆时针旋转微小角度2°，导致外部大磁体产生的磁场发生旋转，该旋转磁场驱动小磁体(连同磁性胶囊内窥镜一起)绕自身轴向中心轴顺时针旋转(磁性胶囊内窥镜旋转方向与外部大磁铁的旋转方向相反，如图3(b)所示)。
步骤1.3：计算旋转后的小永磁体的径向磁化方向单位向量
Figure BDA0003082299470000053
(m1 2+n1 2+p1 2＝1)。具体过程为：先屏蔽或移除外部大磁体的磁场，然后通过磁传感器阵列，获得由旋转后的小磁体产生的当前磁感应强度
Figure BDA0003082299470000054
再按照下述步骤计算小磁体的当前磁化方向单位向量
Figure BDA0003082299470000055
①建立目标函数：
Figure BDA0003082299470000056
其中，
Figure BDA0003082299470000057
b1，n＝B1，nxyn-B1， nyxn，
Figure BDA0003082299470000058
Figure BDA0003082299470000059
是旋转后的小磁体在坐标为(xn，yn，zn)的第n个磁传感器处产生的磁感应强度矢量，m1′＝m1/p1，n1′＝n1/p1。
②利用非线性优化算法求解上述目标函数，求得旋转后的小磁体(即磁性胶囊内窥镜)的姿态参数m1′和n1′。
③根据下式计算小磁体旋转后的磁化方向单位向量
Figure BDA0003082299470000061
Figure BDA0003082299470000062
m1＝m1′p1
n1＝n1′p1
步骤1.4：由
Figure BDA0003082299470000063
和
Figure BDA0003082299470000064
计算磁性胶囊内窥镜的预估轴向方向单位向量
Figure BDA0003082299470000065
计算公式为：
r＝n0p1-n1p0
s＝m1p0-m0p1
t＝m0n1-m1n0
Figure BDA0003082299470000066
Figure BDA0003082299470000067
Figure BDA0003082299470000068
其中，
Figure BDA0003082299470000069
和
Figure BDA00030822994700000610
分别表示旋转前和旋转后小磁体的磁化方向单位矢量，
Figure BDA00030822994700000611
为磁性胶囊内窥镜的预估轴向方向单位矢量(即
Figure BDA00030822994700000612
)。
步骤2：调整外部大磁体的姿态，使外部大磁体的姿态与磁性胶囊内窥镜的初始姿态一致，即：使外部大磁体的轴向方向与磁性胶囊内窥镜的预估轴向方向(即
Figure BDA00030822994700000613
)相同，如图1所示，且外部大磁铁的径向磁化方向与永磁体的当前径向磁化方向(即
Figure BDA00030822994700000614
)同向，如图3(a)所示。
步骤3：利用外部大磁体控制磁性胶囊内窥镜绕其自身轴向中心轴旋转。
本实施例中，外部大磁体控制磁性胶囊内窥镜旋转的方式为：控制外部大磁体绕自身轴向中心轴顺时针旋转4°，导致外部大磁体产生的磁场发生旋转，该旋转磁场驱动小磁体(连同磁性胶囊内窥镜一起)绕自身轴向中心轴逆时针旋转，如图4所示。(磁性胶囊内窥镜旋转方向与外部大磁铁的旋转方向相反。)
步骤4：计算旋转后磁性胶囊内窥镜内小磁体的当前径向磁化方向单位向量
Figure BDA0003082299470000071
具体过程为：
①屏蔽外部大磁体磁场，通过磁传感器阵列，检测得到由小磁体经步骤3旋转后产生的磁感应强度当前值
Figure BDA0003082299470000072
并建立目标函数：
Figure BDA0003082299470000073
其中，
Figure BDA0003082299470000074
b2，n＝B2，nxyn-B2， nyxn，
Figure BDA00030822994700000712
是小磁体在坐标为(xn，yn，zn)的第n个磁传感器处产生的磁感应强度值，m2′＝m2/p2，n2′＝n2/p2。
②利用非线性优化算法求解上述目标函数，求得旋转后的小磁体的当前位置坐标(a，b，c)和姿态参数m2′和n2′。
③根据下式计算旋转后的小磁体的当前磁化方向单位向量
Figure BDA0003082299470000077
Figure BDA0003082299470000078
m2＝m2′p2；
n2＝n2′p2；
步骤5：计算所述磁性胶囊内窥镜的轴向方向单位向量
Figure BDA0003082299470000079
Figure BDA00030822994700000710
即完全确定胶囊内窥镜的当前姿态。
计算公式为：
r＝n1p2-n2p1；
s＝m2p1-m1p2；
t＝m1n2-m2n1；
Figure BDA00030822994700000711
Figure BDA0003082299470000081
Figure BDA0003082299470000082
其中，
Figure BDA0003082299470000083
和
Figure BDA0003082299470000084
分别表示步骤3旋转(即第二次旋转)前和旋转后小磁体的径向磁化方向的单位矢量，如图4所示，
Figure BDA0003082299470000085
为磁性胶囊内窥镜的轴向方向的单位矢量(即
Figure BDA0003082299470000086
)。由于小磁体的径向磁化方向，与磁性胶囊内窥镜具有固定关系，且与磁性胶囊内窥镜的轴向方向不同，因此，由
Figure BDA0003082299470000087
即完全确定磁性胶囊内窥镜的当前姿态。
由
Figure BDA0003082299470000088
和
Figure BDA0003082299470000089
计算磁性胶囊内窥镜的横滚角增量
Figure BDA00030822994700000810
Figure BDA00030822994700000811
由(
Figure BDA00030822994700000812
Δθ)即确定磁性胶囊内窥镜旋转前的姿态。
本实施例中，用
Figure BDA00030822994700000813
更新
Figure BDA00030822994700000814
重复步骤3至步骤5，可连续地完全确定磁性胶囊内窥镜的姿态。
本实施例中，N＝25，已知传感器坐标(x1，y1，z1)＝(-0.16，-0.1685，0.017)，(x2，y2，z2)＝(-0.08，-0.1685，0.017)，(x3，y3，z3)＝(0，-0.1685，0.017)，(x4，y4，z4)＝(0.08，-0.1685，0.017)，(x5，y5，z5)＝(0.16，-0.1685，0.017)，(x6，y6，z6)＝(-0.16，0.0885，0.017)，(x7，y7，z7)＝(-0.08，0.0885，0.017)，(x8，y8，z8)＝(0，0.0885，0.017)，(x9，y9，z9)＝(0.08，0.0885，0.017)，(x10，y10，z10)＝(0.16，0.0885，0.017)，(x11，y11，z11)＝(-0.16，0.0085，0.017)，(x12，y12，z12)＝(-0.08，0.0085，0.017)，(x13，y13，z13)＝(0，0.0085，0.017)，(x14，y14，z14)＝(0.08，0.0085，0.017)，(x15，y15，z15)＝(0.16，0.0085，0.017)，(x16，y16，z16)＝(-0.16，-0.0715，0.017)，(x17，y17，z17)＝(-0.08，-0.0715，0.017)，(x18，y18，z18)＝(0，-0.0715，0.017)，(x19，y19，z19)＝(0.08，-0.0715，0.017)，(x20，y20，z20)＝(0.16，-0.0715，0.017)，(x21，y21，z21)＝(-0.16，-0.1515，0.017)，(x22，y22，z22)＝(-0.08，-0.1515，0.017)，(x23，y23，z23)＝(0，-0.1515，0.017)，(x24，y24，z24)＝(0.08，-0.1515，0.017)，(x25，y25，z25)＝(0.16，-0.1515，0.017)。
本实施例中，磁性胶囊内窥镜中心点坐标与小永磁体的中心点坐标相同，理论值均为
Figure BDA0003082299470000091
磁性胶囊内窥镜姿态设为轴向与正X轴同向(磁性胶囊内窥镜摄像头端为正向)，径向磁化方向与正Z轴同向，即：(r，s，t)理论值为(1，0，0)，(m，n，p)理论值为(0，0，1)，横滚角理论值为0度。
由磁传感器阵列采集到的磁感应强度为
Figure BDA0003082299470000092
Figure BDA0003082299470000093
Figure BDA0003082299470000094
Figure BDA0003082299470000095
Figure BDA0003082299470000096
Figure BDA0003082299470000097
Figure BDA0003082299470000098
Figure BDA0003082299470000099
Figure BDA00030822994700000910
Figure BDA00030822994700000911
Figure BDA00030822994700000912
Figure BDA00030822994700000913
Figure BDA00030822994700000914
Figure BDA00030822994700000915
Figure BDA00030822994700000916
Figure BDA00030822994700000917
Figure BDA00030822994700000918
Figure BDA00030822994700000919
Figure BDA00030822994700000920
Figure BDA0003082299470000101
Figure BDA0003082299470000102
Figure BDA0003082299470000103
Figure BDA0003082299470000104
Figure BDA0003082299470000105
Figure BDA0003082299470000106
Figure BDA0003082299470000107
Figure BDA0003082299470000108
Figure BDA0003082299470000109
Figure BDA00030822994700001010
Figure BDA00030822994700001011
通过设置过小(小于1)和过大(超传感器量程)的值为无效值，去除1号传感器的数据
Figure BDA00030822994700001012
和
Figure BDA00030822994700001013
由剩余24个传感器数据
Figure BDA00030822994700001014
和
Figure BDA00030822994700001015
计算得：
Figure BDA00030822994700001016
然后由
Figure BDA00030822994700001017
和
Figure BDA00030822994700001018
计算得胶囊镜的初始预估姿态
Figure BDA00030822994700001019
由
Figure BDA00030822994700001020
计算得：
Figure BDA00030822994700001021
磁性胶囊内窥镜中心位置坐标(a，b，c)＝(0.002388，-0.002005，0.118974)。然后由
Figure BDA00030822994700001022
和
Figure BDA00030822994700001023
计算得胶囊镜姿态参数中的轴向单位向量
Figure BDA00030822994700001024
由
Figure BDA00030822994700001025
和
Figure BDA00030822994700001026
计算横滚角Δθ＝1.76°，逆时针方向为正。
由于位置坐标的理论值
Figure BDA00030822994700001027
(r，s，t)理论值为(1，0，0)，(m，n，p)理论值为(0，0，1)，横滚角理论值为0°，因此本实施例中，胶囊镜的
Figure BDA00030822994700001028
Figure BDA0003082299470000111
胶囊镜姿态参数中的轴向单位向量误差＝|(r2，s2，t2)-(1，0，0)|＝(0.0026，0.0543，0.0463)，转换为(轴向向量分别与XYZ三轴的夹角)角度误差为(4.13°，3.11°，2.65°)；姿态参数中的横滚角误差＝Δθ-0＝1.76°。
本发明所涉及的小磁体的形状还可以是横截面为正方形或多边形的立方体。
本发明所涉及的步骤1.1、步骤1.3、步骤4中，计算小磁体的径向磁化方向向量，可由现有的磁偶极子模型及其改进方法或现有的根据磁感应强度计算磁源磁化方向的任意方法替代。
本发明所涉及的步骤2中，使外部大磁体的姿态与磁性胶囊内窥镜的初始姿态一致，还可以是：使外部大磁体的轴向方向与磁性胶囊内窥镜的预估轴向方向轴(即
Figure BDA0003082299470000112
)重合(即外部大磁体与磁性胶囊内窥镜同轴)，且所述大磁体的径向磁化方向与小磁体的径向磁化方向(即
Figure BDA0003082299470000113
)相反。(此种情况下，步骤3中，所述小磁体的旋转方向与外部大磁体的旋转方向是同向的。)
本发明所设计的步骤5中，还可以由
Figure BDA0003082299470000114
和
Figure BDA0003082299470000115
计算磁性胶囊内窥镜的轴向方向单位向量
Figure BDA0003082299470000116
计算公式为：
r＝n0p2-n2p0；
s＝m2p0-m0p2；
t＝m0n2-m2n0；
Figure BDA0003082299470000117
Figure BDA0003082299470000118
Figure BDA0003082299470000119
应当理解的是，上述针对较佳实施例的描述较为详细，并不能因此而认为是对本发明专利保护范围的限制，本领域的普通技术人员在本发明的启示下，在不脱离本发明权利要求所保护的范围情况下，还可以做出替换或变形，均落入本发明的保护范围之内，本发明的请求保护范围应以所附权利要求为准。

Claims (10)

1.一种磁性胶囊内窥镜全姿态测定方法，采用磁性胶囊内窥镜；所述胶囊内窥镜内设置的永磁体是径向充磁的小永磁体；所述小永磁体是圆柱状或圆环状，固定设置于所述磁性胶囊内窥镜的内部或固定于圆环形磁性胶囊内窥镜外壳壁上，且所述小永磁体的轴向方向与所述磁性胶囊内窥镜的轴向方向一致；所述胶囊内窥镜外部设置有大永磁体，所述大永磁体是径向充磁的圆柱状强永磁铁；
其特征在于，所述方法包括以下步骤：
步骤1：估计磁性胶囊内窥镜的初始姿态，确定所述磁性胶囊内窥镜内小永磁体的径向磁化方向单位向量
Figure FDA0003082299460000011
和轴向方向单位向量
Figure FDA0003082299460000012
具体实现包括以下子步骤：
步骤1.1：计算所述小永磁体的径向磁化方向单位向量
Figure FDA0003082299460000013
步骤1.2：根据所述小永磁体的径向磁化方向向量，利用外部大永磁体控制所述磁性胶囊内窥镜旋转；
步骤1.3：计算所述小永磁体旋转后的径向磁化方向单位向量
Figure FDA0003082299460000014
步骤1.4：由
Figure FDA0003082299460000015
和
Figure FDA0003082299460000016
计算所述磁性胶囊内窥镜的预估轴向方向单位向量
Figure FDA0003082299460000017
步骤2：调整外部大永磁体的姿态，使外部大永磁体的姿态与所述磁性胶囊内窥镜的当前姿态一致；
步骤3：利用外部大永磁体控制所述磁性胶囊内窥镜绕其轴向中心轴旋转；
步骤4：计算旋转后的所述磁性胶囊内窥镜内小永磁体的当前径向磁化方向单位向量
Figure FDA0003082299460000018
步骤5：计算所述磁性胶囊内窥镜的轴向方向单位向量
Figure FDA0003082299460000019
Figure FDA00030822994600000110
即完全确定所述胶囊内窥镜的当前姿态。
2.根据权利要求1所述的磁性胶囊内窥镜全姿态测定方法，其特征在于：步骤1.1中，通过磁传感器阵列，检测由所述小永磁体旋转前产生的磁感应强度
Figure FDA00030822994600000111
根据
Figure FDA00030822994600000112
将所述小永磁体视作点源，计算所述小永磁体的磁化方向单位向量
Figure FDA00030822994600000113
3.根据权利要求2所述的磁性胶囊内窥镜全姿态测定方法，其特征在于：所述磁传感器阵列由不少于5个三轴磁性传感器构成，固定于所述磁性胶囊内窥镜的外部。
4.根据权利要求1所述的磁性胶囊内窥镜全姿态测定方法，其特征在于：步骤1.2中，首先放置所述外部大永磁铁，使所述大永磁体的径向磁化方向与小永磁体的径向磁化方向同向；然后控制所述外部大永磁体绕自身轴向中心轴旋转任一微小角度，导致所述外部大永磁体产生的磁场发生旋转，该旋转磁场驱动所述小永磁体及所述磁性胶囊内窥镜一起绕自身轴向中心轴旋转，所述磁性胶囊内窥镜旋转方向与所述外部大磁铁的旋转方向相反。
5.根据权利要求1所述的磁性胶囊内窥镜全姿态测定方法，其特征在于：步骤1.3中，通过磁传感器阵列，检测由所述小永磁体旋转后产生的磁感应强度
Figure FDA0003082299460000021
根据
Figure FDA0003082299460000022
将所述小永磁体视作点源，计算所述小永磁体的磁化方向单位向量
Figure FDA0003082299460000023
6.根据权利要求1所述的磁性胶囊内窥镜全姿态测定方法，其特征在于：步骤1.4中，计算所述磁性胶囊内窥镜的预估轴向方向单位向量
Figure FDA0003082299460000024
Figure FDA0003082299460000025
其中，r＝n0p1-n1p0，s＝m1p0-m0p1，t＝m0n1-m1n0；
Figure FDA0003082299460000026
和
Figure FDA0003082299460000027
分别表示旋转前和旋转后小永磁体的径向磁化方向的单位矢量。
7.根据权利要求1所述的磁性胶囊内窥镜全姿态测定方法，其特征在于：步骤2中，使所述外部大永磁体的轴向方向与所述胶囊内窥镜的预估轴向方向相同，且所述外部大永磁铁的径向磁化方向与所述小永磁体的当前径向磁化方向同向。
8.根据权利要求1所述的磁性胶囊内窥镜全姿态测定方法，其特征在于：步骤3中，控制所述外部大永磁体绕自身轴向中心轴旋转微小角度，导致所述外部大永磁体产生的磁场发生旋转，该旋转磁场驱动所述小永磁体及所述磁性胶囊内窥镜一起绕自身轴向中心轴旋转，所述磁性胶囊内窥镜旋转方向与所述外部大磁铁的旋转方向相反。
9.根据权利要求1所述的磁性胶囊内窥镜全姿态测定方法，其特征在于：步骤4中，通过磁传感器阵列，检测由所述小永磁体经步骤3旋转后产生的磁感应强度
Figure FDA0003082299460000031
根据
Figure FDA0003082299460000032
将所述小永磁体视作点源，计算所述小永磁体经步骤3旋转后的磁化方向单位向量
Figure FDA0003082299460000033
即
Figure FDA0003082299460000034
10.根据权利要求1-9任意一项所述的磁性胶囊内窥镜全姿态测定方法，其特征在于：步骤5中，计算所述磁性胶囊内窥镜的轴向方向单位向量
Figure FDA0003082299460000035
Figure FDA0003082299460000036
其中，r＝n1p2-n2p1，s＝m2p1-m1p2，t＝m1n2-m2n1；由于所述小永磁体的径向磁化方向，与所述磁性胶囊内窥镜具有固定关系，且与所述磁性胶囊内窥镜的轴向方向不同，因此，由所述小永磁体的径向磁化方向向量
Figure FDA0003082299460000037
和轴向方向向量
Figure FDA0003082299460000038
确定所述磁性胶囊内窥镜的当前姿态；由
Figure FDA0003082299460000039
和
Figure FDA00030822994600000310
计算所述磁性胶囊内窥镜的横滚角增量
Figure FDA00030822994600000311
由
Figure FDA00030822994600000312
确定所述磁性胶囊内窥镜旋转前的姿态。
CN202110570007.7A 2021-05-25 2021-05-25 一种磁性胶囊内窥镜全姿态测定方法 Active CN113288008B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202110570007.7A CN113288008B (zh) 2021-05-25 2021-05-25 一种磁性胶囊内窥镜全姿态测定方法
JP2021102594A JP7270284B2 (ja) 2021-05-25 2021-06-21 磁気カプセル内視鏡の全姿勢測定システムの作動方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110570007.7A CN113288008B (zh) 2021-05-25 2021-05-25 一种磁性胶囊内窥镜全姿态测定方法

Publications (2)

Publication Number Publication Date
CN113288008A true CN113288008A (zh) 2021-08-24
CN113288008B CN113288008B (zh) 2023-07-18

Family

ID=77324602

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110570007.7A Active CN113288008B (zh) 2021-05-25 2021-05-25 一种磁性胶囊内窥镜全姿态测定方法

Country Status (2)

Country Link
JP (1) JP7270284B2 (zh)
CN (1) CN113288008B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113917377A (zh) * 2021-10-09 2022-01-11 深圳市资福医疗技术有限公司 磁力测量设备
CN115067863A (zh) * 2022-05-31 2022-09-20 元化智能科技(深圳)有限公司 基于球型驱动器的无线胶囊内窥镜驱动***

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2135545A2 (en) * 2008-06-19 2009-12-23 Olympus Medical Systems Corporation Magnetically guiding system and magnetically guiding method
CN101801254A (zh) * 2007-09-11 2010-08-11 奥林巴斯医疗株式会社 胶囊引导***和胶囊引导方法
CN101826780A (zh) * 2009-03-07 2010-09-08 深圳先进技术研究院 驱动磁体的方法以及驱动胶囊内窥镜的方法和***
CN101842043A (zh) * 2007-10-30 2010-09-22 西门子公司 用于引导胶囊内窥镜的方法和内窥镜***
US20180008131A1 (en) * 2016-03-04 2018-01-11 Olympus Corporation Guidance apparatus and capsule medical apparatus guidance system
CN208837887U (zh) * 2017-11-22 2019-05-10 湖北大学 一种外部永磁体同轴控制磁性螺旋型胶囊内窥镜装置
CN112515611A (zh) * 2020-11-30 2021-03-19 元化智能科技(深圳)有限公司 无线胶囊内窥镜的定位方法、装置和终端设备

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2016157596A1 (ja) 2015-03-31 2017-04-27 オリンパス株式会社 カプセル型内視鏡誘導システムおよびカプセル型内視鏡誘導装置

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101801254A (zh) * 2007-09-11 2010-08-11 奥林巴斯医疗株式会社 胶囊引导***和胶囊引导方法
CN101842043A (zh) * 2007-10-30 2010-09-22 西门子公司 用于引导胶囊内窥镜的方法和内窥镜***
EP2135545A2 (en) * 2008-06-19 2009-12-23 Olympus Medical Systems Corporation Magnetically guiding system and magnetically guiding method
CN101826780A (zh) * 2009-03-07 2010-09-08 深圳先进技术研究院 驱动磁体的方法以及驱动胶囊内窥镜的方法和***
US20180008131A1 (en) * 2016-03-04 2018-01-11 Olympus Corporation Guidance apparatus and capsule medical apparatus guidance system
CN208837887U (zh) * 2017-11-22 2019-05-10 湖北大学 一种外部永磁体同轴控制磁性螺旋型胶囊内窥镜装置
CN112515611A (zh) * 2020-11-30 2021-03-19 元化智能科技(深圳)有限公司 无线胶囊内窥镜的定位方法、装置和终端设备

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
叶波 等: "胶囊内窥镜悬浮"同步"旋转控制模型研究", 科技经济市场, no. 3, pages 15 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113917377A (zh) * 2021-10-09 2022-01-11 深圳市资福医疗技术有限公司 磁力测量设备
CN115067863A (zh) * 2022-05-31 2022-09-20 元化智能科技(深圳)有限公司 基于球型驱动器的无线胶囊内窥镜驱动***
CN115067863B (zh) * 2022-05-31 2023-03-14 元化智能科技(深圳)有限公司 基于球型驱动器的无线胶囊内窥镜驱动***

Also Published As

Publication number Publication date
CN113288008B (zh) 2023-07-18
JP7270284B2 (ja) 2023-05-10
JP2022181146A (ja) 2022-12-07

Similar Documents

Publication Publication Date Title
Song et al. 6-D magnetic localization and orientation method for an annular magnet based on a closed-form analytical model
Popek et al. Six-degree-of-freedom localization of an untethered magnetic capsule using a single rotating magnetic dipole
Di Natali et al. Real-time pose detection for magnetic medical devices
Bao et al. Hybrid localization of microrobotic endoscopic capsule inside small intestine by data fusion of vision and RF sensors
CN113288008B (zh) 一种磁性胶囊内窥镜全姿态测定方法
CN107348931B (zh) 一种胶囊内窥镜空间姿态测定***
JP2022547189A (ja) デジタル磁力計を用いた可撓性カテーテルの磁気追跡システムおよび方法
CN211633195U (zh) 胶囊内窥镜的磁定位***
US20160037998A1 (en) Endoscopic Operating System and Endoscopic Operation Program
CN112515611B (zh) 无线胶囊内窥镜的定位方法、装置和终端设备
CN106937860A (zh) 获知实时位姿的胶囊内窥镜***及其工作方法
CN108759812B (zh) 三维封闭非结构空间内胶囊机器人及待测目标的相对定位方法
CN112493970B (zh) 无线胶囊内窥镜的追踪定位方法及***
Di Natali et al. A wireless platform for in vivo measurement of resistance properties of the gastrointestinal tract
CN107374566B (zh) 一种基于变化磁场的胶囊内窥镜全姿态测定***
Hu et al. A new 6D magnetic localization technique for wireless capsule endoscope based on a rectangle magnet
Li et al. Calibrated analytical model for magnetic localization of wireless capsule endoscope based on onboard sensing
CN115886692B (zh) 磁控悬浮胶囊机器人的实时定位方法、***及存储介质
CN109620108B (zh) 一种双半球型胶囊机器人弯曲肠道内视觉导航方法
CN115067863B (zh) 基于球型驱动器的无线胶囊内窥镜驱动***
Liu et al. Hybrid magnetic and vision localization technique of capsule endoscope for 3D recovery of pathological tissues
WO2022193411A1 (zh) 胶囊内窥镜***及其胶囊内窥镜磁定位方法
CN113647893B (zh) 无线胶囊内窥镜的自主导航***、设备及介质
CN113545731B (zh) 胶囊内窥镜***
Zhang et al. A multimagnetometer array and inner IMU-based capsule endoscope positioning system

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