[发明专利]胶囊内镜姿态检测校准方法及系统

说明书

本发明公开了一种胶囊内镜姿态检测校准方法及系统，该系统包括胶囊姿态控制器、校准控制器，校准控制器定时获取胶囊姿态控制器输出的控制信息和胶囊的姿态信息，校准控制器对比胶囊的姿态信息以及胶囊姿态控制器输出的控制信息，当两者存在差值时，胶囊姿态控制器控制胶囊接近静止状态，校准控制器将胶囊姿态控制器输出的控制信息传输给胶囊内窥镜；胶囊内镜以该控制信息为新的初始点重新计算姿态并将姿态信息传输给校准控制器，直至胶囊内镜新的姿态信息中与胶囊姿态控制器输出的控制信息一致。本发明每隔一段时间对航向角进行一次误差归零操作，提高检测精度和效果。本发明通过分段校准使数据更新率高、稳定性好，长期检测时精度高。

技术领域

本发明涉及内窥镜技术领域，特别涉及一种胶囊内镜姿态检测校准方法。

背景技术

胶囊内镜是一种新兴的诊断技术，它有助于监测通过常规内窥镜检查技术无法达到的胃肠道。胶囊内镜发展到现在大部分的产品对小肠检查有较好效果，而针对发病较高的胃部的检查胶囊很少。现有胶囊内镜用于胃部检查时会搭配胶囊姿态控制器，以方便医生使用，减少漏诊。在使用可控的胶囊内镜时，胶囊内镜的拍摄方向必然是医生关注的一个重要问题，镜头朝向会给操作的医生一个判断位置的指导作用，帮助医生更快速地判断胶囊内镜大概在胃的什么部位(如胃的五个关键位置：贲门、胃底、胃体、胃窦、幽门)。

胶囊内镜姿态可以描述为横滚角、俯仰角和航向角，现有胶囊内镜姿态检测的主流技术为磁感应+加速度计检测方案。其检测原理主要分为两部分，一是横滚角和俯仰角的检测，它们可由加速度计测量重力分量计；二是航向角检测，航向角主要依靠磁感应检测技术，其原理是利用永磁体在它周围会产生一个磁场，可以依据已有的永磁体磁场模型公式计算各个位置的磁场强度。反之，如果知道空间中一些特定位置上的磁场强度，也可以反算出永磁体的位置和方向。实际应用中，采用磁传感器阵列测量空间中特定位置的磁场强度，当永磁体目标在阵列中移动的时候，磁传感器的输出(差动电压)就会变化，这个变化和其所处位置的磁感应强度有关。根据传感器的有效信号，利用一种可行算法，就可以求解出永磁体的位置和方向信息。这种磁感应+加速度计检测技术的优点：精度较高，航向角测量准确性不会产生累积误差。其缺点是无法保证横滚角和俯仰角的动态准确性；存在受外部磁场干扰的风险，需要更多的算法来弥补磁场的干扰。

鉴于磁感应+加速度计检测方案技术的局限性，惯性技术作为一种完全自主的姿态检测技术，可达到不受磁场干扰的实时动态姿态检测。惯性技术主要利用惯性器件进行姿态检测，惯性器件由加速度计和陀螺仪组成，公开号为CN106937860A中公开了一种“获知实时位姿的胶囊内窥镜系统及其工作方法”，通过陀螺仪和加速度计组合可得到胶囊的姿态角，由于位置、速度和姿态角等信息经过积分而产生，故所得信息误差随时间而增大，长期精度差。该技术方案采用扩展卡尔曼滤波算法进行补偿，但是姿态角中的航向角会随时间漂移，航向角因无参考导致无法修正，所以航向角的误差会随时间增加而增加，影响检测精度和效果。

发明内容

本发明旨在至少解决现有技术中存在的技术问题，特别创新地提出了一种胶囊内镜姿态检测校准方法及系统。

为了实现本发明的上述目的，根据本发明的第一个方面，本发明提供了一种胶囊内镜姿态检测校准方法，其包括如下步骤：

S1，校准控制器定时获取胶囊姿态控制器输出的控制信息和胶囊的姿态信息，校准控制器对比胶囊的姿态信息以及胶囊姿态控制器输出的控制信息，当两者存在差值时执行步骤S2，如果两者没有差值，则返回重新执行步骤S1；

S2，校准控制器将胶囊姿态控制器输出的控制信息传输给胶囊内窥镜；

S3，胶囊内镜获得该控制信息后，利用该控制信息重置胶囊内部数据，以该控制信息为新的初始点重新计算姿态并将姿态信息传输给校准控制器，如果胶囊新的姿态信息与胶囊姿态控制器输出的控制信息一致，则T时间后返回步骤S1，否则直接返回步骤S1，所述T为正数。