CN109044249A - 胶囊内镜姿态检测校准方法及*** - Google Patents
胶囊内镜姿态检测校准方法及*** Download PDFInfo
- Publication number
- CN109044249A CN109044249A CN201810963808.8A CN201810963808A CN109044249A CN 109044249 A CN109044249 A CN 109044249A CN 201810963808 A CN201810963808 A CN 201810963808A CN 109044249 A CN109044249 A CN 109044249A
- Authority
- CN
- China
- Prior art keywords
- capsule
- controller
- attitude
- control information
- calibration
- 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
Links
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/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
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Biomedical Technology (AREA)
- Optics & Photonics (AREA)
- Pathology (AREA)
- Radiology & Medical Imaging (AREA)
- Biophysics (AREA)
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Heart & Thoracic Surgery (AREA)
- Medical Informatics (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Endoscopes (AREA)
Abstract
本发明公开了一种胶囊内镜姿态检测校准方法及***,该***包括胶囊姿态控制器、校准控制器,校准控制器定时获取胶囊姿态控制器输出的控制信息和胶囊的姿态信息,校准控制器对比胶囊的姿态信息以及胶囊姿态控制器输出的控制信息,当两者存在差值时,胶囊姿态控制器控制胶囊接近静止状态,校准控制器将胶囊姿态控制器输出的控制信息传输给胶囊内窥镜;胶囊内镜以该控制信息为新的初始点重新计算姿态并将姿态信息传输给校准控制器,直至胶囊内镜新的姿态信息中与胶囊姿态控制器输出的控制信息一致。本发明每隔一段时间对航向角进行一次误差归零操作,提高检测精度和效果。本发明通过分段校准使数据更新率高、稳定性好,长期检测时精度高。
Description
技术领域
本发明涉及内窥镜技术领域,特别涉及一种胶囊内镜姿态检测校准方法。
背景技术
胶囊内镜是一种新兴的诊断技术,它有助于监测通过常规内窥镜检查技术无法达到的胃肠道。胶囊内镜发展到现在大部分的产品对小肠检查有较好效果,而针对发病较高的胃部的检查胶囊很少。现有胶囊内镜用于胃部检查时会搭配胶囊姿态控制器,以方便医生使用,减少漏诊。在使用可控的胶囊内镜时,胶囊内镜的拍摄方向必然是医生关注的一个重要问题,镜头朝向会给操作的医生一个判断位置的指导作用,帮助医生更快速地判断胶囊内镜大概在胃的什么部位(如胃的五个关键位置:贲门、胃底、胃体、胃窦、幽门)。
胶囊内镜姿态可以描述为横滚角、俯仰角和航向角,现有胶囊内镜姿态检测的主流技术为磁感应+加速度计检测方案。其检测原理主要分为两部分,一是横滚角和俯仰角的检测,它们可由加速度计测量重力分量计;二是航向角检测,航向角主要依靠磁感应检测技术,其原理是利用永磁体在它周围会产生一个磁场,可以依据已有的永磁体磁场模型公式计算各个位置的磁场强度。反之,如果知道空间中一些特定位置上的磁场强度,也可以反算出永磁体的位置和方向。实际应用中,采用磁传感器阵列测量空间中特定位置的磁场强度,当永磁体目标在阵列中移动的时候,磁传感器的输出(差动电压)就会变化,这个变化和其所处位置的磁感应强度有关。根据传感器的有效信号,利用一种可行算法,就可以求解出永磁体的位置和方向信息。这种磁感应+加速度计检测技术的优点:精度较高,航向角测量准确性不会产生累积误差。其缺点是无法保证横滚角和俯仰角的动态准确性;存在受外部磁场干扰的风险,需要更多的算法来弥补磁场的干扰。
鉴于磁感应+加速度计检测方案技术的局限性,惯性技术作为一种完全自主的姿态检测技术,可达到不受磁场干扰的实时动态姿态检测。惯性技术主要利用惯性器件进行姿态检测,惯性器件由加速度计和陀螺仪组成,公开号为CN106937860A中公开了一种“获知实时位姿的胶囊内窥镜***及其工作方法”,通过陀螺仪和加速度计组合可得到胶囊的姿态角,由于位置、速度和姿态角等信息经过积分而产生,故所得信息误差随时间而增大,长期精度差。该技术方案采用扩展卡尔曼滤波算法进行补偿,但是姿态角中的航向角会随时间漂移,航向角因无参考导致无法修正,所以航向角的误差会随时间增加而增加,影响检测精度和效果。
发明内容
本发明旨在至少解决现有技术中存在的技术问题,特别创新地提出了一种胶囊内镜姿态检测校准方法及***。
为了实现本发明的上述目的,根据本发明的第一个方面,本发明提供了一种胶囊内镜姿态检测校准方法,其包括如下步骤:
S1,校准控制器定时获取胶囊姿态控制器输出的控制信息和胶囊的姿态信息,校准控制器对比胶囊的姿态信息以及胶囊姿态控制器输出的控制信息,当两者存在差值时执行步骤S2,如果两者没有差值,则返回重新执行步骤S1;
S2,校准控制器将胶囊姿态控制器输出的控制信息传输给胶囊内窥镜;
S3,胶囊内镜获得该控制信息后,利用该控制信息重置胶囊内部数据,以该控制信息为新的初始点重新计算姿态并将姿态信息传输给校准控制器,如果胶囊新的姿态信息与胶囊姿态控制器输出的控制信息一致,则T时间后返回步骤S1,否则直接返回步骤S1,所述T为正数。
本发明的胶囊内镜姿态检测校准方法每隔一段时间对航向角进行一次误差归零操作,提高检测精度和效果。本发明的分段校准方案,通过分段校准使数据更新率高、稳定性好,长期检测时精度高。
根据本发明的一种优选实施方式,所述胶囊姿态控制器输出的控制信息为胶囊的方向信息,保证胶囊的方向信息周期性误差归零,精度和稳定性好。
为了实现本发明的上述目的,根据本发明的第二个方面,本发明提供了一种胶囊内镜姿态检测校准方法的校准***,其包括胶囊姿态控制器、校准控制器,校准控制器定时获取胶囊姿态控制器输出的控制信息和胶囊的姿态信息,校准控制器对比胶囊的姿态信息以及胶囊姿态控制器输出的控制信息,当两者存在差值时,胶囊姿态控制器控制胶囊接近静止状态,校准控制器将胶囊姿态控制器输出的控制信息传输给胶囊内窥镜;胶囊内镜获得该控制信息后,利用该控制信息重置胶囊内部数据,以该控制信息为新的初始点重新计算姿态并将姿态信息传输给校准控制器,直至胶囊内镜新的姿态信息与胶囊姿态控制器输出的控制信息一致。
本发明的校准***每隔一段时间对航向角进行一次误差归零操作,提高检测精度和效果。本发明的分段校准方案,通过分段校准使数据更新率高、稳定性好,长期检测时精度高。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1是本发明一种优选实施方式中胶囊内镜姿态检测校准方法的流程框图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。
在本发明的描述中,除非另有规定和限定,需要说明的是,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是机械连接或电连接,也可以是两个元件内部的连通,可以是直接相连,也可以通过中间媒介间接相连,对于本领域的普通技术人员而言,可以根据具体情况理解上述术语的具体含义。
本发明提供了一种胶囊内镜姿态检测校准方法,如图1所示,其包括如下步骤:
S1,校准控制器定时获取胶囊姿态控制器输出的控制信息和胶囊的姿态信息,校准控制器对比胶囊的姿态信息以及胶囊姿态控制器输出的控制信息,当两者存在差值时执行步骤S2,如果两者没有差值,则返回重新执行步骤S1;
S2,校准控制器将胶囊姿态控制器输出的控制信息传输给胶囊内窥镜;
S3,胶囊内镜获得该控制信息后,利用该控制信息重置胶囊内部数据,以该控制信息为新的初始点重新计算姿态并将姿态信息传输给校准控制器,如果胶囊新的姿态信息与胶囊姿态控制器输出的控制信息一致,则T时间后返回步骤S1,否则直接返回步骤S1,所述T为正数。
在本实施方式中,胶囊姿态控制器输出的控制信息为胶囊的方向信息。
本发明每隔一段时间对胶囊姿态进行一次误差归零操作,胶囊姿态控制器优选外部磁控制器。校准控制器(本实施方式中可以为上位机)定时获取磁控制器的方向信息,并将该方向信息下发给胶囊内镜;胶囊内镜获得该方向信息后,根据该方向信息马上重置内部数据,以该方向信息为新的初始点重新积分计算姿态,从而使误差归零。
在本实施方式中,以该控制信息为新的初始点重新计算姿态的方法为:胶囊内窥镜获得胶囊姿态控制器输出的胶囊方向信息后,利用加速度传感器数据ax,ay,az求解初始水平姿态角(包括横滚角和俯仰角),结合从胶囊姿态控制器获得的方向信息确定此时的初始姿态,胶囊姿态控制器控制胶囊接近静止状态,根据初始俯仰角、横滚角以及接收到的方向信息确定初始四元数q0,q1,q2,q3,利用陀螺仪测量角速度信息wx,wy,wz,更新四元组得到q0',q1',q2',q3',更具更新后的四元数得到姿态矩阵求解姿态矩阵得到胶囊内镜的航向角、俯仰角和横滚角。具体计算方法可参考现有技术。
本发明还提供了一种胶囊内镜姿态检测校准方法的校准***,其包括胶囊姿态控制器、校准控制器,校准控制器定时获取胶囊姿态控制器输出的控制信息和胶囊的姿态信息,校准控制器对比胶囊的姿态信息以及胶囊姿态控制器输出的控制信息,当两者存在差值时,胶囊姿态控制器控制胶囊接近静止状态(速度为零或接近为零),校准控制器将胶囊姿态控制器输出的控制信息传输给胶囊内窥镜;胶囊内镜获得该控制信息后,利用该控制信息重置胶囊内部数据,以该控制信息为新的初始点重新计算姿态并将姿态信息传输给校准控制器,直至胶囊内镜新的姿态信息与胶囊姿态控制器输出的控制信息一致。
该校准***还包括显示装置,所述显示装置与校准控制器连接,实时显示胶囊的姿态信息。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管已经示出和描述了本发明的实施例,本领域的普通技术人员可以理解:在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由权利要求及其等同物限定。
Claims (5)
1.一种胶囊内镜姿态检测校准方法,其特征在于,包括如下步骤:
S1,校准控制器定时获取胶囊姿态控制器输出的控制信息和胶囊的姿态信息,校准控制器对比胶囊的姿态信息以及胶囊姿态控制器输出的控制信息,当两者存在差值时执行步骤S2,如果两者没有差值,则返回重新执行步骤S1;
S2,校准控制器将胶囊姿态控制器输出的控制信息传输给胶囊内窥镜;
S3,胶囊内镜获得该控制信息后,利用该控制信息重置胶囊内部数据,以该控制信息为新的初始点重新计算姿态并将姿态信息传输给校准控制器,如果胶囊新的姿态信息与胶囊姿态控制器输出的控制信息一致,则T时间后返回步骤S1,否则直接返回步骤S1,所述T为正数。
2.根据权利要求1所述的胶囊内镜姿态检测校准方法,其特征在于,所述胶囊姿态控制器输出的控制信息为胶囊的方向信息。
3.根据权利要求1或2所述的胶囊内镜姿态检测校准方法,其特征在于,以该控制信息为新的初始点重新计算姿态的方法为:胶囊内窥镜获得胶囊姿态控制器输出的胶囊方向信息后,利用加速度传感器数据ax,ay,az求解初始水平姿态角,结合从胶囊姿态控制器获得的方向信息确定此时的初始姿态,根据初始俯仰角、横滚角以及接收到的方向信息确定初始四元数q0,q1,q2,q3,利用陀螺仪测量角速度信息wx,wy,wz,更新四元组得到q0',q1',q2',q3',更具更新后的四元数得到姿态矩阵求解姿态矩阵得到胶囊内镜的航向角、俯仰角和横滚角。
4.一种利用权利要求1所述胶囊内镜姿态检测校准方法的校准***,其特征在于,包括胶囊姿态控制器、校准控制器,校准控制器定时获取胶囊姿态控制器输出的控制信息和胶囊的姿态信息,校准控制器对比胶囊的姿态信息以及胶囊姿态控制器输出的控制信息,当两者存在差值时,胶囊姿态控制器控制胶囊接近静止状态,校准控制器将胶囊姿态控制器输出的控制信息传输给胶囊内窥镜;胶囊内镜获得该控制信息后,利用该控制信息重置胶囊内部数据,以该控制信息为新的初始点重新计算姿态并将姿态信息传输给校准控制器,直至胶囊内镜新的姿态信息与胶囊姿态控制器输出的控制信息一致。
5.根据权利要求4所述的校准***,其特征在于,还包括显示装置,所述显示装置与校准控制器连接,实时显示胶囊的姿态信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810963808.8A CN109044249B (zh) | 2018-08-23 | 2018-08-23 | 胶囊内镜姿态检测校准方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810963808.8A CN109044249B (zh) | 2018-08-23 | 2018-08-23 | 胶囊内镜姿态检测校准方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109044249A true CN109044249A (zh) | 2018-12-21 |
CN109044249B CN109044249B (zh) | 2022-02-15 |
Family
ID=64756596
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810963808.8A Active CN109044249B (zh) | 2018-08-23 | 2018-08-23 | 胶囊内镜姿态检测校准方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109044249B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110772210A (zh) * | 2019-11-08 | 2020-02-11 | 重庆金山医疗技术研究院有限公司 | 一种诊断交互***及方法 |
CN111693019A (zh) * | 2020-05-20 | 2020-09-22 | 西安交通大学 | 一种姿态传感装置及数据融合、姿态解算方法 |
CN113729599A (zh) * | 2021-09-27 | 2021-12-03 | 重庆金山医疗技术研究院有限公司 | 一种磁控胶囊内窥镜的探测方法及其*** |
CN114966511A (zh) * | 2022-05-18 | 2022-08-30 | 安翰科技(武汉)股份有限公司 | 感测设备校正方法及校正*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1956675A (zh) * | 2004-05-26 | 2007-05-02 | 奥林巴斯株式会社 | 位置关系检测装置以及位置关系检测*** |
CN101426413A (zh) * | 2006-04-19 | 2009-05-06 | 奥林巴斯医疗株式会社 | 胶囊型医疗装置 |
EP2098160A1 (en) * | 2008-03-05 | 2009-09-09 | Olympus Medical Systems Corporation | In-vivo image acquiring apparatus, in-vivo image receiving apparatus, in-vivo image displaying apparatus, and noise eliminating method |
CN107260110A (zh) * | 2017-05-26 | 2017-10-20 | 重庆金山医疗器械有限公司 | 一种胶囊内镜运动控制方法及*** |
CN107405052A (zh) * | 2016-03-04 | 2017-11-28 | 奥林巴斯株式会社 | 引导装置以及胶囊型医疗装置引导*** |
-
2018
- 2018-08-23 CN CN201810963808.8A patent/CN109044249B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1956675A (zh) * | 2004-05-26 | 2007-05-02 | 奥林巴斯株式会社 | 位置关系检测装置以及位置关系检测*** |
CN101426413A (zh) * | 2006-04-19 | 2009-05-06 | 奥林巴斯医疗株式会社 | 胶囊型医疗装置 |
EP2098160A1 (en) * | 2008-03-05 | 2009-09-09 | Olympus Medical Systems Corporation | In-vivo image acquiring apparatus, in-vivo image receiving apparatus, in-vivo image displaying apparatus, and noise eliminating method |
CN107405052A (zh) * | 2016-03-04 | 2017-11-28 | 奥林巴斯株式会社 | 引导装置以及胶囊型医疗装置引导*** |
CN107260110A (zh) * | 2017-05-26 | 2017-10-20 | 重庆金山医疗器械有限公司 | 一种胶囊内镜运动控制方法及*** |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110772210A (zh) * | 2019-11-08 | 2020-02-11 | 重庆金山医疗技术研究院有限公司 | 一种诊断交互***及方法 |
CN111693019A (zh) * | 2020-05-20 | 2020-09-22 | 西安交通大学 | 一种姿态传感装置及数据融合、姿态解算方法 |
CN111693019B (zh) * | 2020-05-20 | 2021-04-20 | 西安交通大学 | 一种姿态传感装置及数据融合、姿态解算方法 |
CN113729599A (zh) * | 2021-09-27 | 2021-12-03 | 重庆金山医疗技术研究院有限公司 | 一种磁控胶囊内窥镜的探测方法及其*** |
CN114966511A (zh) * | 2022-05-18 | 2022-08-30 | 安翰科技(武汉)股份有限公司 | 感测设备校正方法及校正*** |
WO2023222009A1 (zh) * | 2022-05-18 | 2023-11-23 | 安翰科技(武汉)股份有限公司 | 感测设备校正方法及校正*** |
CN114966511B (zh) * | 2022-05-18 | 2024-05-10 | 安翰科技(武汉)股份有限公司 | 感测设备校正方法及校正*** |
Also Published As
Publication number | Publication date |
---|---|
CN109044249B (zh) | 2022-02-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109044249A (zh) | 胶囊内镜姿态检测校准方法及*** | |
CN105698765B (zh) | 双imu单目视觉组合测量非惯性系下目标物位姿方法 | |
CN110108279B (zh) | 一种杆塔倾斜测量***及倾斜解算方法 | |
KR102368230B1 (ko) | 폴더블 디바이스의 두 몸체부의 사이각 측정 방법 및 이를 위한 장치 | |
JP2019527076A (ja) | 配向検知機構を有する電子弁リーダ | |
US20210102970A1 (en) | Mems sensor with compensation of residual voltage | |
CN106937860A (zh) | 获知实时位姿的胶囊内窥镜***及其工作方法 | |
JP6746037B2 (ja) | 攻撃検知装置、攻撃検知プログラム及び攻撃検知方法 | |
Cheuk et al. | Automatic calibration for inertial measurement unit | |
US11125560B2 (en) | Robust method for tuning of gyroscope demodulation phase | |
CN112485470B (zh) | 低噪声多轴微机电***加速度计 | |
JP7111869B2 (ja) | 機首方位測定システムにおけるセンサ測定の欠如を補償するシステムと方法 | |
CN109579832A (zh) | 一种人员高度自主定位算法 | |
CN105547291B (zh) | 室内人员自主定位***的自适应静止检测方法 | |
CN112611380A (zh) | 基于多imu融合的姿态检测方法及其姿态检测装置 | |
KR101089989B1 (ko) | 공기 데이터 센서장치 | |
Teruyama et al. | Effectiveness of Variable‐Gain Kalman Filter Based on Angle Error Calculated from Acceleration Signals in Lower Limb Angle Measurement with Inertial Sensors | |
JP5264497B2 (ja) | 形状/加速度測定機器および装置 | |
JP4593347B2 (ja) | 回転飛翔体 | |
JP5190134B2 (ja) | 角速度検出方法及びその装置 | |
US10809062B2 (en) | MEMS inertial sensor device with determination of the bias value of a gyroscope thereof and corresponding method | |
EP3387451B1 (en) | Residual voltage self test for accelerometers | |
Hu et al. | Attitude sensing system design for wireless micro-ball endoscopy | |
CN106705954B (zh) | 浮球平台载体姿态测量方法 | |
CN116236174A (zh) | 胶囊内窥镜的姿态测定方法、装置及终端设备 |
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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20210903 Address after: 401120 1-1, 2-1, 3-1, building 5, No. 18, Cuiping Lane 2, Huixing street, Yubei District, Chongqing Applicant after: Chongqing Jinshan Medical Technology Research Institute Co.,Ltd. Address before: 401120 1 office buildings, Jinshan International Industrial City, 18 of Nei sang Road, Hui Xing street, Yubei District, Chongqing. Applicant before: CHONGQING JINSHAN MEDICAL APPLIANCE Co.,Ltd. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |