CN115316918A - 全方位观察欠驱动胶囊机器人及其轴线翻转磁控操作方法 - Google Patents

Abstract

本发明公开一种全方位观察欠驱动胶囊机器人及其轴线翻转磁控操作方法，将径向磁化钕铁硼磁环以非连接方式装入胶囊球体内腔，钕铁硼磁环单独跟随旋转磁场绕胶囊轴线空转并完全悬浮于胶囊球体充满硅油的内腔，在同轴随动磁矩驱动下，欠驱动胶囊球体不能绕胶囊轴线自转，但胶囊轴线能跟随磁场旋转轴同步翻转。通过万向磁场控制胶囊轴线与垂直方向成一定夹角的锥面范围内依次扫描或者在与肠道弯曲方向平行的竖直平面内作连续圆形翻转，便可分别实现胶囊机器人在体腔内的万向观察诊断和在包括胃肠道内部约束环境下沿弯曲方向的转弯行走。本发明提高了胶囊扫描范围，增强环境适应性，胶囊定点调姿精度高，翻滚行走稳定，视觉观察效果好，应用前景良好。

Description

全方位观察欠驱动胶囊机器人及其轴线翻转磁控操作方法

技术领域

本发明属于自动化工程技术领域，涉及全方位观察欠驱动胶囊机器人及其轴线翻转磁控操作方法，具体是一种由空间万向旋转磁场产生的同轴随动磁矩效应对整体欠驱动胶囊机器人轴线翻转运动轨迹实施规划的途径实现胃肠道等场景内全方位观察与诊疗的磁控操作方法。

背景技术

随着社会发展节奏的加快，胃肠疾病逐年增长，严重威胁人类健康。利用内窥镜对消化道疾病进行早期诊断能有效提高治愈率，但传统插入式胃肠镜操作复杂，并给患者带来不适感与心理恐惧，甚至带来伤害，因此，不适宜大规模胃肠疾病筛查。

无痛式胶囊内窥镜给患者带来了福音，并成为小肠内无创检查的唯一手段。然而，目前用于临床的被动式胶囊内窥镜主要依靠重力及胃肠蠕动行走，胶囊内窥镜在人体胃肠宽裕环境内的位姿具有随机性，医生尚不能操控胶囊内窥镜对胃肠重点区域进行观察，存在漏检率高，检测效率低等问题，可见，被动式胶囊内窥镜在临床上依然具有局限性。

针对被动胶囊内窥镜存在的问题，以实现胶囊运动与姿态主动控制为目标，研究主动式胶囊机器人迫在眉睫，可望提高胃部及结肠等宽裕环境内的检测效率，并为定点施药与取样奠定基础。

目前，无电缆主动式胶囊机器人内嵌磁体驱动器，主要采用体外永磁体和电磁装置两种驱动方式实现胶囊的运动与姿态控制。尽管体外永磁体驱动方式解决了胶囊机器人无线能源供给问题，并实现了临床应用，但通过体外永磁体对胶囊进行运动与姿态精准控制条件苛刻、实施难度大。原因是体外永磁体产生梯度磁场，胶囊同时受到磁力与磁矩作用，梯度磁场产生的磁力与磁矩相互耦合，并分别随胶囊到体外永磁体的距离r以指数规律1/r⁴和1/r³下降，由于临床操作时体内胶囊与磁铁距离r的实时检测与控制困难，会因磁力与磁矩较大范围变化而导致胶囊静态平衡控制困难。

首先，采用永磁体的静态磁力平衡实现胶囊位置控制安全性差。由于胶囊所受磁力随胶囊到磁源距离r以指数变化，磁源到胶囊机器人距离的微小改变就会严重影响磁力的变化，对于体脂率变化较大的患者，胶囊机器人会因磁力的突变而失去平衡，并存在冲击器官内壁的危险。此外，磁力与磁矩耦合还会加剧磁力悬浮平衡控制的难度。

其次，采用永磁体的静态磁矩平衡实现胶囊姿态控制随机性高。由于随着胶囊和外部永磁体距离的增大，胶囊受到的磁力比磁矩衰减快一个数量级，因此，当胶囊与外部永磁体达到较大合适距离r时，便可忽略磁力影响，可近似认为胶囊只受磁矩作用，并认为实现了梯度磁场下磁力与磁矩的解耦。显然，纯磁矩静态平衡下的胶囊姿态控制更加容易，但由于距离r较大时，磁矩衰减较大，甚至会出现磁矩不足以克服胃肠道粘性阻尼而导致姿态控制失败。临床上，为了实现胃内部检测，操作者必须借助患者喝下液体产生的浮力克服重力，使胶囊在液体内处于力平衡状态，于是，不仅能通过微小磁力实现液体内悬浮胶囊的位置控制，还能通过较小磁矩对液体内悬浮胶囊实施姿态的自由灵活调整。悬浮胶囊不与胃壁接触，避免了因磁矩不足以克服胃肠道粘性阻尼而导致胶囊姿态控制失败的情形。然而，由于胶囊采用静态平衡下的磁悬浮控制，尽管胃内液体会对胶囊磁力突变激励运动产生较大阻碍作用，有效避免冲击器官内壁带来的危险，但为了在胃内部找到合适的位置与方位视角对特定部位进行观察，专门操作人员必须凭借经验通过外部永磁体位置与方位的反复调整，才能建立胶囊静态磁矩平衡下的姿态控制，临床普及推广困难。可见，采用体外永磁体控制胶囊姿态效率低、难度大。尤其是当胶囊被胃肠组织紧密包裹时，会因磁矩不足以克服胃肠组织紧密包裹阻力而导致姿态控制失效。

最后，胶囊姿态有时具有非唯一性。胶囊机器人内嵌磁铁存在奇异面，在奇异面内胶囊姿态具有非唯一性，胶囊姿态处于失控状态。尤其是在肠胃宽裕环境内，通过体外磁铁对胶囊进行姿态与运动控制难度更大。上述因素制约了外部永磁体驱动胶囊的临床应用推广。

综上所述，尽管患者饮入液体会带来诸多不便，但根据外部永磁体磁力与磁矩的解耦特性和远距离衰减特征，只有采用磁矩驱动才能借助液体浮力实现胶囊位置与姿态的有效控制，并能保证安全性。尽管姿态调整效率低，但磁矩驱动方式为胶囊机器人姿态的有效控制提供了新的探索途径。

与外部永磁体产生的梯度磁场相比，电磁场可通过电流对磁场大小及方位实施数字化控制，磁场调整更加灵活、便利，尤其是可通过三轴正交亥姆霍兹线圈叠加产生空间万向均匀旋转磁场，胶囊内嵌磁体在均匀旋转磁场内只产生耦合纯磁矩，线圈均匀区内磁矩恒定且无衰减，完全实现磁力与磁矩解耦，即消除了磁力对磁矩的影响，通过纯磁矩控制胶囊的姿态精度高，灵活性好，安全性好，可望解决胶囊在胃肠宽裕环境内的姿态与运动控制难题。

为了克服永磁体以静态平衡控制胶囊姿态的局限性，鉴于纯磁矩操纵优势，我们提出采用空间万向旋转磁场的耦合纯磁矩操控胶囊姿态的动态平衡控制方案，同时，我们发现了同轴随动磁矩效应，即径向磁化圆柱磁体在跟随空间万向旋转磁场旋转时，其轴线方向始终跟随并最终与旋转磁场法向量方向(磁场旋转轴线)保持一致，同轴随动磁矩效应不仅为空间万向电机的驱动提供了新的探索途径，也为胶囊姿态的准确控制奠定了基础。在大连理工大学所申请的发明专利“一种电磁驱动两自由度球型机器人手腕及其控制方法”中(专利授权ZL202010484343.5)详细给出了“同轴随动磁矩效应”的数学证明如下：

o-x₀y₀z₀为地面固定坐标系，假设初始时放入旋转磁场中的径向永磁体保持水平，其中心轴线n_B与y₀轴重合，如图1位置1所示，径向磁化永磁体的磁矩矢量为m₁，径向磁化永磁体在旋转磁场作用下绕中心轴线同步转动，角速度为ω，m_B为径向磁化永磁体磁化强度值，则径向磁化永磁体在转动过程中磁矩矢量m₁在坐标系o-x₀y₀z₀中表示为：

此时，施加方向为n_f(侧摆角θ＝0，俯仰角δ＝λ)的空间万向旋转磁场，旋转磁矢量幅值为B₀，旋转磁矢量B₁在坐标系o-x₀y₀z₀可表示为：

根据矢量外积公式，径向磁化永磁体在空间万向旋转磁场中受到磁力矩为：

由式(3)可得径向磁化永磁体在空间万向旋转磁场中受到各个方向磁力矩T_x,T_y,T_z均为周期函数，周期分别为:t_x＝t_y＝t_z＝π/ω，在初始位置时俯仰角λ为定值，此时单个周期内径向磁化永磁体在各个方向所受到平均力矩为：

由式(4)可知，径向磁化永磁体在空间万向旋转磁场中单个周期内所受到的平均力矩为绕ox₀轴旋转的平均力矩

将此力矩称为同轴随动磁矩，其他方向所受到平均力矩为0。在同轴随动磁矩

的作用下，径向磁化永磁体跟随旋转磁场法向量偏转，最终到达位置2，使得径向磁化永磁体中心轴线方向n_B与旋转磁场法向量n_f方向一致。

可见，同轴随动磁矩效应可望解决胶囊姿态驱动与控制问题。为此，依据陀螺稳定性原理，我们提出纯磁矩驱动胶囊姿态的动态控制方法，与基于磁悬浮的胶囊姿态静平衡控制方式不同，旋转磁场驱动下的高速旋转胶囊机器人具有良好的动态平衡特性和抗干扰能力，胶囊姿态动平衡控制过程更简单、迅速、便利，通过控制旋转磁场轴线的改变，基于同轴随动磁矩效应，便可实现胶囊姿态的调整。研究中，我们还发现单体结构胶囊实现定点姿态控制困难，因为胶囊姿态调整时容易发生滚动，事实上，胶囊内窥镜在小肠内的检查效果最好，但在胃肠道宽裕环境下更容易翻滚，姿态控制难度大。在胃肠道非结构宽裕环境下，球形胶囊滚动灵活性最好，在胃肠道宽裕环境下检测时，为避免调姿时球形机器人发生滚动，且需保证机器人轴线在原地与旋转磁场同步随动，结合球形结构调姿与转弯的灵活性与万向性，依据空间万向旋转磁场同轴随动磁矩效应调姿的稳定性与唯一性特征，大连理工大学所申请的专利“一种主被动双半球形胶囊机器人及其姿态调整与转弯驱动控制方法”(专利授权号：ZL201510262778.4)中，提出一种主被动双半球胶囊机器人，空间万向旋转磁场与主动半球体内嵌径向磁化钕铁硼圆环耦合产生同轴随动磁矩，驱动主动半球体相对被动半球体空转，被动半球体处于欠驱动状态，欠驱动半球体结构增强了双半球形胶囊机器人姿态调整的稳定性和对非结构环境的自适应能力，实现定点悬停调姿和滚动行走双重控制模态的切换。实现双半球胶囊定点悬停调姿：主动半球体始终处于上方，被动半球体处于下方，被动半球体在接触肠道约束下处于静止状态，胶囊不会发生滚动，改变旋转磁场轴线方向(在与胃肠道表面垂直方向夹角约30度的锥面范围内扫描观察)，在同轴随动磁矩效应作用下，胶囊轴线与旋转磁场轴线同步随动，胶囊的“悬停”姿态可任意调整，实现全景观察。实现胶囊机器人沿肠道弯曲方向滚动：借助胶囊机器人前端图像传输装置调整空间万向旋转磁矢量方位角使机器人轴线与肠道弯曲法线方向基本一致，并在水平面内施加与肠道弯曲方向垂直的旋转磁矢量，在同轴随动磁矩效应作用下，机器人轴线跟随到水平旋转磁矢量方向，主动半球体和被动半球体均与肠道下壁接触，耦合磁矩驱动主动半球体接触肠道下壁主动滚动，欠驱动半球体与肠道下壁被动滚动，使双半球形胶囊机器人在肠道内沿一定弯曲方向滚动有限距离。

为了利用双半球形胶囊无线传输图像对准并检测出肠道弯曲方向，实现弯曲肠道内胶囊的磁导航，在大连理工大学所申请的发明专利“一种双半球型胶囊机器人弯曲肠道内双图像视觉导航方法”(授权号：ZL201910227499.2)中，给出了利用无线传输图像的具体导航方法。该方法首先利用双半球型胶囊机器人轴线与万向磁场旋转轴线的同轴随动特性，即双半球型胶囊机器人轴线、摄像机光轴和万向磁场旋转轴线都重合，结合同一俯仰角和两个不同侧摆角下单目摄像机所拍摄的两幅无线传输图像确定双半球型胶囊机器人的姿态信息；然后结合得到的姿态信息，在万向均匀旋转磁场条件下推导双半球型胶囊机器人的视觉导航方位，即通过计算固定坐标系下弯曲肠道图像暗区质心的方位来调整双半球型胶囊机器人姿态准确对准肠道弯曲方向，并确定双半球型胶囊机器人转弯滚动磁场轴线方向，实现双半球型胶囊机器人在肠道内的视觉辅助导航作业。

为了依据同轴随动磁矩效应对胶囊进行更为便捷的姿态控制，实现胶囊轴线与磁场控制旋转轴线的统一，必须解决以胶囊侧摆与俯仰角度为变量，实现空间万向旋转磁场方位的数字化控制。在大连理工大学所申请的发明专利“一种空间万向旋转磁场人机交互控制方法”(专利授权号：ZL 201610009285.4)中，为了叠加出以侧摆角θ与俯仰角δ为旋转轴线的空万向旋转磁场，具体给出了经纬坐标系内以侧摆角θ与俯仰角δ两个角度为输入变量的电流形式的空间万向旋转磁场叠加公式:

其中o-xyz为万向磁场固定坐标系，

I₀为三组正交亥姆霍兹线圈中正弦电流的幅值，ω为施加正弦信号电流的角频率，施加正弦信号电流的频率为f＝2π/ω。将空间万向旋转磁场的三维叠加问题转化为平面内的两维叠加问题，并通过两个操纵杆分别将侧摆与俯仰角度分离控制，实现低维度可分离变量交互式控制。

尽管双半球型胶囊机器人解决了定点悬停调姿和滚动行走双重模态的转换问题，试验中，我们发现主被动双半球胶囊机器人仍存在姿态调整范围小、非结构复杂环境适应性差等问题，尤其是存在慢速移位精确控制与稳定性差之间的矛盾，影响肠胃疾病检测的临床应用效果。

被动模态定点调姿存在的问题：1)姿态调整范围有限，无法实现包括胶囊下部胃肠壁的全方位观察。一般观察作业时双半球胶囊的姿态调整角度范围在与垂直方向夹角约30度的锥面范围内，如果姿态调整角度太大时，主动半球容易与胃肠组织接触并滚动，导致定点调姿失效。2)非结构复杂环境内胶囊姿态调整功能受限。当胶囊陷于胃肠道狭小下凹区域时，主动半球更容易与胃肠道接触，姿态角度调整范围更小，尤其是胶囊被胃肠组织完全紧密包裹时将导致姿态调整功能失效，事实上，为了拓展胶囊取样与定点喷药等功能，胶囊必须具备胃肠道非结构复杂环境内的万向姿态调整能力，这是极具挑战性的研究难题。3)偏心振动会影响定点姿态控制精度和视觉观察效果。调姿时内嵌径向磁化磁环的主动半球一直跟随磁场旋转，主动半球增加了转子的转动惯量，如果径向磁化磁环与主动半球存在安装偏心误差，必然会发生振动而影响胶囊姿态控制的稳定性与精度。

主动模态滚动行走存在如下问题：1)姿态稳定与慢速精确移位需求之间存在矛盾。由于胶囊滚动速度与磁场旋转速度相同，磁场转速太快不利于胶囊机器人位移的精确控制与观察，磁场转速较低，则胶囊机器人稳定性差，滚动方向控制困难。2)复杂环境内的容错滚动功能受限。在弯曲肠道内滚动时，如果滚动方向与肠道弯曲方向不同，双半球胶囊将与肠壁接触产生相对滑转或滑移的功率寄生现象，影响胶囊稳定性与滚动行走方向，进而影响转弯功能，转弯顺应能力需改进。3)胶囊滚动行走时会影响视觉观察效果。尽管双半球胶囊视觉系统与被动半球固连，被动模态调整姿态时，视觉系统与被动半球不发生转动，但胶囊在主动模态滚动时，视觉系统连同被动半球会随主动半球一同滚动而直接影响视觉观察效果。

针对双半球胶囊姿态调整范围小和复杂环境适应能力受限等问题，拟申请专利提出一种由空间万向旋转磁场操控的全方位观察整体欠驱动球形胶囊机器人。与半球主动、半球欠驱动的双半球胶囊结构不同，胶囊整球完全采用欠驱动结构，即将径向磁化钕铁硼磁环以非连接方式装入胶囊球体内腔，钕铁硼磁环单独跟随旋转磁场绕胶囊轴线空转并完全悬浮于胶囊球体充满硅油的内腔，在同轴随动磁矩驱动下，尽管欠驱动胶囊球体完全不能绕胶囊轴线自转(胶囊球体受肠道下凹区域及粘液约束而静止)，但胶囊轴线能跟随磁场旋转轴同步翻转。因此，通过万向磁场同步控制胶囊轴线翻转运动轨迹规划，就能实现欠驱动胶囊的全方位定点调姿与翻滚行走：当控制胶囊轴线轨迹在与胃肠壁表面垂直轴线方向成一定夹角的锥面范围内(0～±90°)运动时，即可实现胶囊姿态的万向扫描观察；当控制胶囊轴线轨迹沿与肠道弯曲方向平行的竖直平面内作连续圆形翻转时，即实现胶囊翻滚式扫描观察。

所提出的欠驱动球形胶囊显著提高了全方位观察性能和非结构环境适应性：1)显著增加了胶囊姿态调整范围。由于欠驱动胶囊球体与肠胃组织接触不发生滚动，扫描范围不受限制，胶囊轴线可跟随磁场旋转轴线万向翻转，甚至实现了包括胶囊下部胃肠壁的全方位观察。2)增强了复杂肠道环境适应性，试验表明，即使胶囊在胃肠组织包裹下或者陷于胃肠道狭小下凹区域时，同轴随动磁矩完全能够克服胃肠壁阻力并使胶囊轴线跟随旋转磁场轴线同步万向翻转，由于胶囊采用动态姿态控制，胃肠壁阻尼更有利于胶囊控制的稳定控制，实现胃肠道在线全方位观察，而整个球体却不发生滚动，视觉观察效果好，为拓展胶囊的取样与定点喷药等功能奠定了基础。3)胶囊抑振效果好，定点调姿与行走精度高，视觉观察效果好。原因是跟随旋转磁场独立空转的钕铁硼磁环完全悬浮于胶囊球体充满硅油的内腔，视觉等电子模块完全嵌入球体，由于欠驱动球体不随磁场转动，因此，视觉观察效果不受影响，尤其是球体内部器件的制造与安装偏心不会引起振动，因此，提高了胶囊的稳定性与姿态控制精度，视觉观察效果好。4)保证了胶囊在非结构复杂弯曲肠道环境内的容错翻滚行走能力。在弯曲肠道内翻滚行走时，如果滚动方向与肠道弯曲方向不同，欠驱动球体与肠壁接触发生自适应滚动，避免发生滑转或滑移的功率寄生现象，提高了胶囊转弯顺应能力。5)解决了姿态稳定与慢速精确移位需求之间存在的矛盾。胶囊滚动速度与旋转磁场转速无关，磁场转速快有利于胶囊稳定，机器人观察与控制，胶囊滚动速度与磁场轴线翻转转速有关，胶囊姿态稳定与慢速精确移位可以独立控制实现。

事实上，必须保证欠驱动球形胶囊不发生自转滚动，并实现姿态稳定控制，才能通过胶囊轴线翻转运动轨迹控制实现万向定点扫描与翻滚行走。由于跟随磁场空转的钕铁硼磁环悬浮于胶囊球体充满硅油的环形密封腔，为了防止油膜产生流体摩擦力矩带动胶囊球体转动(自转)，破坏定点调姿的稳定性，必须减小流体摩擦力矩。

在大连理工大学所申请的发明专利“一种胶囊机器人及其多楔形效应驱动控制方法”(专利授权号：ZL200910306805.8)中将“楔形效应”应用于圆柱形胶囊外廓形设计。使旋转胶囊在轴截面内与管壁之间构成多个楔形空间，多楔形效应可增大液体油膜动压力，减小了胶囊与管壁之间的流体粘性转矩，进而减小了对管壁的扭转作用。有鉴于此，拟申请专利的欠驱动球形胶囊也通过改变充满硅油的球体内腔廓形，增加钕铁硼磁环与球体内腔接触面形成流体油膜的动压力，避免与球体外壳直接接触，并减小对球形胶囊的流体粘性转矩作用，有效防止磁环带动胶囊转动(自转)而失稳。

据掌握的资料和立项查新显示，目前，国内外还没有采用空间万向旋转磁场同轴随动磁矩效应实现欠驱动胶囊在胃肠组织包裹下依然能够全方位扫描观察的相关资料报道，因此，本发明具有较为突出的原创性。

发明内容

为了提高主动胶囊在非结构复杂环境内的控制性能，本发明提供一种将径向磁化钕铁硼磁环以完全悬浮方式装入胶囊球体内的环形密封腔所构成的整球欠驱动胶囊结构，在空间万向旋转磁场同轴随动磁矩直接引导驱动下，通过胶囊轴线跟随磁场旋转轴同步翻转运动轨迹规划实现胶囊全方位定点调姿或者翻滚行走的磁场操控方法。

本发明的技术方案是：

一种全方位观察欠驱动胶囊机器人，包括欠驱动球体1和径向磁化钕铁硼磁环2，在空间万向旋转磁场作用下，实现欠驱动球体1在胃肠道内的万向定点调姿扫描观察和翻滚行走两种功能。

所述的欠驱动球体1包括整体外壳Ⅰ、摄像模块Ⅱ、无线传输模块Ⅲ以及供电电池11。供电电池11、摄像模块Ⅱ、无线传输模块Ⅲ集成于欠驱动球体1中，实现胶囊的供电、图像拍摄、照明以及图像传输功能。由于欠驱动球体1不能跟随空间万向旋转磁场绕胶囊机器人中心轴线自转，保证了胶囊机器人动态调姿的稳定性和良好的视觉观察效果。

所述整体外壳Ⅰ包括透明端盖3、上壳体4、密封圈5以及下壳体6。透明端盖3、上壳体4以及下壳体6相互嵌合，保证胶囊机器人整体形状为球形，且在欠驱动球体1内形成环形密封腔。

所述的环形密封腔的构成如下：上壳体4的中心设有一圆柱体，二者顶部通过连接端面固定为一体，圆柱体与上壳体4内壁之间的空隙构成环形槽；上壳体4的内壁作为外环形面，圆柱体的外壁作为内环形面，外环形面上带有多个圆柱形凸起，内环形面光滑，位于环形槽一侧的连接端面的表面上带有多个球形凸起，密封圈5嵌入上壳体4内部环形槽内，与连接端面相对的密封圈5的端面上带有多个球形凸起，共同构成环形密封腔的两个端面和内外环形面；环形密封腔内充满硅油，密封圈5的作用是为环形密封腔提供一个带多个球形凸起的内端面并防止硅油泄露。

所述的径向磁化钕铁硼磁环2套在上壳体4中心的圆柱体上，以非连接方式装入欠驱动球体1充满硅油的环形密封腔内，欠驱动球体1完全处于欠驱动姿态，欠驱动球体1对胃肠道等非结构环境的适应性好，也是实现全方位定点调姿功能的关键。胶囊机器人在空间万向旋转磁场内部工作时，径向磁化钕铁硼磁环2单独跟随旋转磁场绕胶囊机器人中心轴线空转并完全悬浮于欠驱动球体1充满硅油的环形密封腔内，胶囊欠驱动球体1处于静止状态。

所述的径向磁化钕铁硼磁环2的两个端面与欠驱动球体1的环形密封腔的两个带多个凸起的端面之间分别形成两个多楔形空间；所述的径向磁化钕铁硼磁环2的外环形面与欠驱动球体1的带多个凸起的外环形面之间形成一个多楔形空间，利用流体多楔形效应，增加了径向磁化钕铁硼磁环2转动时与环形密封腔之间流体油膜的动压力，并减小对欠驱动球体1的流体粘性转矩，并使径向磁化钕铁硼磁环2与环形密封腔同轴，避免了与整体外壳Ⅰ直接接触，有效防止径向磁化钕铁硼磁环2带动欠驱动球体1转动而使胶囊操作过程发生失稳。

所述摄像模块Ⅱ由摄像元件7与LED照明模块8组成，实现胶囊机器人的拍照、照明功能。上壳体4中心的圆柱体上设有凹槽，摄像元件7整体嵌入凹槽之中，LED照明模块8安装于摄像元件7上方并由圆柱体表面进行定位，透明端盖3位于摄像元件7正上方，摄像元件7对外部环境进行摄像。

所述无线传输模块Ⅲ由无线发射装置9与无线发射天线10组成，实现胶囊机器人图像传输功能。无线发射装置9嵌入下壳体6的凹槽内，其底部与供电电池11接触，无线发射天线10嵌入下壳体6周围环形凹槽内。

所述供电电池11对摄像元件7与LED照明模块8、无线发射装置9进行供电。供电电池11嵌于下壳体6的凹槽内。

所述的一种全方位观察欠驱动胶囊机器人实现万向定点扫描观察和翻滚行走两种功能的磁控操作过程是：在空间万向旋转磁场作用下，径向磁化钕铁硼磁环2在同轴随动磁矩驱动下，尽管欠驱动球体1不能绕胶囊机器人中心轴线自转，但欠驱动球体1中心轴线可以跟随磁场旋转轴同步翻转，因此，可以通过径向磁化钕铁硼磁环2带动欠驱动球体1轴线跟随磁场旋转轴同步翻转运动轨迹规划实现胶囊全方位定点调姿或者翻滚行走。通过万向磁场控制胶囊机器人轴线与垂直方向成一定夹角的锥面范围内依次扫描或者在与待测环境弯曲方向平行的竖直平面内作连续圆形翻转，便可分别实现胶囊机器人万向观察诊断和在待测环境(如胃肠道)内部约束下沿弯曲方向的转弯行走。

其中，全方位观察欠驱动胶囊机器人全方位扫描观察控制过程是：

步骤1：实现全方位欠驱动胶囊机器人方位的初始标定：施加旋转磁场的法向量与地面垂直向量n₀一致，基于同轴随动磁矩效应，胶囊机器人轴线n_B最终与旋转磁场法向量保持一致；

步骤2：实现待测环境顶部观察诊断：控制胶囊机器人轴线n_B轨迹与地面垂直向量n₀成一定夹角α的锥面范围内依次运动观察时，基于同轴随动磁矩效应，控制胶囊机器人轴线n_B依次跟随磁场法向量方向进行扫描观察；其中，α的范围为0～90°；

步骤3：实现待测环境底部观察诊断：控制胶囊机器人轴线n_B轨迹与地面垂直向量n₀成一定夹角-α的锥面范围内依次运动观察时，控制胶囊机器人轴线n_B依次跟随磁场法向量方向进行扫描观察。

其中，全方位观察欠驱动胶囊机器人直线与转弯翻滚行走控制过程是：

步骤1：完成待测环境弯曲方向的视觉检测：控制胶囊机器人轴线n_B轨迹与地面垂直向量n₀成一定夹角±α的锥面范围内依次进行扫描观察，直到基本对待准测环境弯曲方向，并通过视觉定位方法确定待测环境弯曲方向；其中，α的范围为0～90°；

步骤2：在直线待测环境内实现滚动行走：根据步骤1判定的待测环境弯曲方向即为胶囊机器人翻转滚动的行走方向，当直线待测环境滚动向量为n_sa时，在地面垂直向量n₀和直线滚动向量n_sa构成的竖直平面V₁内连续改变旋转磁场法向量n_f方位，即控制胶囊机器人轴线n_B在垂直平面V₁内作连续圆形翻转，实现胶囊机器人在待测环境内部约束环境下沿直线翻滚行走功能；

步骤3：在弯曲待测环境内实现滚动行走：根据步骤1判定的待测环境弯曲方向即为胶囊机器人翻转滚动的行走方向，当弯曲待测环境弯曲向量为n_sb时，在地面垂直向量n₀和弯曲滚动向量n_sb构成的竖直平面V内连续改变旋转磁场法向量n_f方位，进而控制胶囊机器人轴线n_B在垂直平面V内作连续圆形翻转。

本发明的效果和益处是：

一种由空间万向旋转磁场操控的全方位观察欠驱动球形胶囊机器人，将径向磁化钕铁硼磁环以完全悬浮方式装入胶囊球体充满硅油的环形密封腔，胶囊整球采用欠驱动结构，径向磁化钕铁硼磁环单独跟随旋转磁场空转并完全悬浮于胶囊球体充满硅油的环形密封腔中心部位，通过改变充满硅油的环形密封腔周围端面和环形面廓形，利用流体多楔形效应，增加径向磁化钕铁硼磁环与环形密封腔之间流体油膜动压力，并减小对球形胶囊的流体粘性转矩，使径向磁化钕铁硼磁环独立空转并完全悬浮于胶囊环形密封腔中心部位，并使径向磁化钕铁硼磁环与环形密封腔同轴，有效防止带动胶囊球体转动而失稳，在空间万向旋转磁场同轴随动磁矩直接引导驱动下，通过胶囊轴线跟随磁场旋转轴同步翻转运动方式的控制实现胶囊全方位定点调姿或者翻滚行走。

本发明提高了胶囊在人体复杂环境内的扫描范围，实现了包括胶囊下部胃肠壁等各种待测环境的全方位观察，增强了复杂肠道环境适应性，胶囊在胃肠组织包裹下或者陷于胃肠道狭小下凹区域时，依然能实现全方位观察，弯曲肠道内容错和自适应翻滚行走能力好，胶囊定点调姿精度高，翻滚行走稳定，视觉观察效果好，应用前景良好。

附图说明

图1是空间万向旋转磁场“同轴随动磁矩效应”原理图。

图2是欠驱动球形胶囊机器人磁场驱动装置与控制系统示意图。

图3是本发明欠驱动球形胶囊机器人整体结构示意图。

图4是本发明中欠驱动球形胶囊机器人内部结构剖面图。

图5(a)是欠驱动胶囊内部环形密封腔安装构成示意图；

图5(b)是欠驱动胶囊环形密封腔剖面图。

图6是欠驱动胶囊机器人全方位扫描磁控操作原理图。

图7是欠驱动胶囊机器人翻滚行走与转弯磁控操作原理图。

图中：o-x₀y₀z₀为地面固定坐标系，o-xyz为万向磁场固定坐标系，位置1-径向磁化永磁体2的初始位姿，位置2-施加法向量方位n_f的旋转磁场后，径向磁化永磁体2最终到达的目标位姿；

a-人机显示界面，b-控制手柄，c-无线图像接收器，d-磁场驱动器，e-被检查者，f-三轴正交嵌套亥姆霍兹线圈磁场叠加装置，g-全方位观察欠驱动球形胶囊机器人，h-病床；

Ⅰ-整体外壳，Ⅱ-摄像模块，Ⅲ-无线传输模块；

1-欠驱动球体，2-径向磁化钕铁硼磁环，3-透明端盖，4-上壳体，5-密封圈，6-下壳体，7-摄像元件，8-LED照明模块，9-无线发射装置，10-无线发射天线，11-供电电池。

具体实施方式

下面结合附图和技术方案详细说明本发明的具体实施方式。

结合图3-4、5(a)、5(b)，说明欠驱动胶囊机器人安装过程如下：

步骤1：将径向磁化钕铁硼磁环2放入上壳体4环形槽内，并在环形槽内充满硅油润滑油，再将密封圈5嵌入上壳体4环形槽内，并采用密封胶水粘合，构成环形密封腔，径向磁化钕铁硼磁环2与环形密封腔周围分别形成三个多楔形空间。

步骤2：将摄像元件7嵌入上壳体4凹槽之中，LED照明模块8安装于摄像元件7上方，其中心孔与摄像元件7上方凸起同轴，其供电导线从上壳体4中心矩形孔内穿过。

步骤3：将供电电池11嵌入下壳体6圆形凹槽内，无线发射装置9嵌入下壳体6矩形凹槽内，其底部与供电电池11接触，无线发射天线10嵌入下壳体6周围的环形缝隙内。

步骤4：将供电电池11电源线与摄像模块Ⅱ以及无线传输模块Ⅲ连接，将摄像模块Ⅱ信号线与无线传输模块Ⅲ信号线连接。最后，将透明端盖3、上壳体4与下壳体6相互嵌合，使得整个胶囊机器人密封，构成整个胶囊机器人外形，完成整个胶囊机器人的装配。

下面以胃肠作为待测环境，结合图2-7说明胶囊机器人对人体胃肠疾病的检测过程：

步骤1：被检查者e吞下全方位观察欠驱动球形胶囊机器人g，并躺在病床h上，调整病床h位置，保证被检查者e位于三轴正交嵌套亥姆霍兹线圈磁场叠加装置f中心区域。

步骤2：通过磁场驱动器d开启三轴正交嵌套亥姆霍兹线圈磁场叠加装置f，欠驱动球形胶囊机器人g在人体内运动，通过摄像模块Ⅱ对人体内胃肠道实时摄像，通过无线模块Ⅲ发射图像信号。

步骤3：由无线图像接收器c接收图像信号，并在人机显示界面a显示。

步骤4：检查者通过画面观察被检查者e体内胃肠道状况，并通过控制手柄b调节磁场方向，对正肠道弯曲方向，从而控制欠驱动球形胶囊机器人g移动到指定观察点，在指定观察点调整胶囊调姿，实现全方位观察，重复上述过程，便可实现胶囊机器人在胃肠道内的遍历检查。

结合图2、3、6说明欠驱动胶囊机器人全方位扫描观察的控制过程：

步骤1：实现欠驱动胶囊机器人方位的初始标定：通过控制手柄b施加旋转磁场的法向量与地面垂直向量n₀一致，基于同轴随动磁矩效应，胶囊机器人轴线n_B最终与旋转磁场法向量保持一致。

步骤2：实现对肠胃组织顶部观察诊断：通过控制手柄b控制胶囊机器人轴线n_B轨迹与地面垂直向量n₀成一定夹角α(0～90°)的锥面范围内依次运动观察时，基于同轴随动磁矩效应，控制胶囊机器人轴线n_B依次跟随磁场法向量方向n_f1→n_f2→n_f3→n_f4进行扫描观察，实现对肠胃组织顶部观察诊断，如图6所示。

步骤3：实现对胃肠组织底部观察诊断：通过控制手柄b控制胶囊机器人轴线n_B轨迹与地面垂直向量n₀成一定夹角-α(0～-90°)的锥面范围内依次运动观察时，控制胶囊机器人轴线n_B依次跟随磁场法向量方向n_f5→n_f6→n_f7→n_f8进行扫描观察，可实现对肠胃组织底部观察诊断，如图6所示。

结合图2、3、7分别说明欠驱动胶囊机器人直线与转弯翻滚行走的控制过程：

步骤1：完成胃肠道弯曲方向的视觉检测：通过控制手柄b控制胶囊机器人轴线n_B轨迹与地面垂直向量n₀成一定夹角±α(0～±90°)的锥面范围内依次进行扫描观察，直到基本对准肠道弯曲方向，并通过视觉定位方法确定肠道弯曲方向。

步骤2：在直线胃肠道内实现滚动行走：根据步骤1判定的肠道弯曲方向即为胶囊机器人翻转滚动的行走方向，当直线肠道滚动向量为n_sa时，在地面垂直向量n₀和直线滚动向量n_sa构成的竖直平面V₁(o_a-n₀n_sa)内连续改变旋转磁场法向量n_f方位n_f1→n_f2→n_f3→n_f4，即控制胶囊机器人轴线n_B在垂直平面V₁内作连续圆形翻转，实现胶囊机器人在胃肠道内部约束环境下沿直线o_an_sa翻滚行走功能(P₀-P₁-P₂-P₃)。在此过程中，根据需要胶囊可随时停止滚动进行全方位定点观察。

步骤3：在弯曲胃肠道内实现滚动行走：根据步骤1判定的肠道弯曲方向即为胶囊机器人翻转滚动的行走方向，当肠道弯曲向量为n_sb时，在地面垂直向量n₀和弯曲滚动向量n_sb构成的竖直平面V(o_b-n₀n_sb)内连续改变旋转磁场法向量n_f方位n_f5→n_f6→n_f7→n_f8，进而控制胶囊机器人轴线n_B在垂直平面V内作连续圆形翻转，由于欠驱动结构具有较好的非结构环境适应性，在弯曲肠道内翻滚行走时，如果滚动方向与肠道弯曲方向不同，欠驱动球体1与肠壁接触发生自适应滚动，避免发生滑转或滑移的功率寄生现象，在肠道作用力F_N的助推下，实现了胶囊机器人转弯，提高了胶囊转弯顺应能力。可控制胶囊机器人顺利通过弯曲肠道。

Claims (4)

1.一种全方位观察欠驱动胶囊机器人，其特征在于，所述的全方位观察欠驱动胶囊机器人包括欠驱动球体(1)和径向磁化钕铁硼磁环(2)；

所述的欠驱动球体(1)包括整体外壳(Ⅰ)、摄像模块(Ⅱ)、无线传输模块(Ⅲ)以及供电电池(11)；供电电池(11)、摄像模块(Ⅱ)、无线传输模块(Ⅲ)集成于欠驱动球体(1)中，实现胶囊的供电、图像拍摄、照明以及图像传输功能；

所述整体外壳(Ⅰ)包括透明端盖(3)、上壳体(4)、密封圈(5)以及下壳体(6)；透明端盖(3)、上壳体(4)以及下壳体(6)相互嵌合，保证胶囊机器人整体形状为球形，且在欠驱动球体(1)内形成环形密封腔；

所述的环形密封腔的构成如下：上壳体(4)的中心设有一圆柱体，二者顶部通过连接端面固定为一体，圆柱体与上壳体(4)内壁之间的空隙构成环形槽；上壳体(4)的内壁作为外环形面，圆柱体的外壁作为内环形面，外环形面上带有多个圆柱形凸起，内环形面光滑，位于环形槽一侧的连接端面的表面上带有多个球形凸起，密封圈(5)嵌入上壳体(4)内部环形槽内，与连接端面相对的密封圈(5)的端面上也带有多个球形凸起，共同构成环形密封腔的两个端面和内外环形面；环形密封腔内充满硅油；

所述的径向磁化钕铁硼磁环(2)套在上壳体(4)中心的圆柱体上，以非连接方式装入欠驱动球体(1)充满硅油的环形密封腔内，欠驱动球体(1)完全处于欠驱动状态；胶囊机器人在空间万向旋转磁场内部工作时，径向磁化钕铁硼磁环(2)单独跟随旋转磁场绕胶囊机器人中心轴线空转并完全悬浮于欠驱动球体(1)充满硅油的环形密封腔内，欠驱动球体(1)处于静止状态；

所述的径向磁化钕铁硼磁环(2)的两个端面与欠驱动球体(1)的环形密封腔的两个带多个凸起的端面之间分别形成两个多楔形空间，所述的径向磁化钕铁硼磁环(2)的外环形面与欠驱动球体(1)的带多个凸起的外环形面之间形成一个多楔形空间；

所述摄像模块(Ⅱ)由摄像元件(7)与LED照明模块(8)组成，实现胶囊机器人的拍照、照明功能；上壳体(4)中心的圆柱体上设有凹槽，摄像元件(7)整体嵌入凹槽之中，LED照明模块(8)安装于摄像元件(7)上方并由圆柱体表面进行定位，透明端盖(3)位于摄像元件(7)正上方，摄像元件(7)对外部环境进行摄像；

所述无线传输模块(Ⅲ)由无线发射装置(9)与无线发射天线(10)组成，实现胶囊机器人图像传输功能；无线发射装置(9)嵌入下壳体(6)的凹槽内，其底部与供电电池(11)接触，无线发射天线(10)嵌入下壳体(6)周围环形凹槽内；

所述供电电池(11)对摄像元件(7)与LED照明模块(8)、无线发射装置(9)进行供电；供电电池(11)嵌于下壳体(6)的凹槽内。

2.一种全方位观察欠驱动胶囊机器人的轴线翻转磁控操作方法，采用权利要求1所述的全方位观察欠驱动胶囊机器人，用于实现万向定点扫描观察和翻滚行走两种功能，其特征在于，磁控操作过程是：在空间万向旋转磁场作用下，径向磁化钕铁硼磁环(2)在同轴随动磁矩驱动下，尽管欠驱动球体(1)不能绕胶囊机器人中心轴线自转，但欠驱动球体(1)中心轴线可以跟随磁场旋转轴同步翻转，因此，通过径向磁化钕铁硼磁环(2)带动欠驱动球体(1)轴线跟随磁场旋转轴同步翻转运动轨迹规划实现胶囊全方位定点调姿或者翻滚行走；通过万向磁场控制胶囊轴线与垂直方向成一定夹角的锥面范围内依次扫描，实现胶囊机器人对待测环境内部的万向观察诊断；通过万向磁场控制胶囊机器人轴线在与待测环境弯曲方向平行的竖直平面内作连续圆形翻转，便可实现胶囊机器人在待测环境内部约束下沿弯曲方向的转弯行走。

3.根据权利要求2所述的一种全方位观察欠驱动胶囊机器人的轴线翻转磁控操作方法，其特征在于，全方位观察欠驱动胶囊机器人全方位扫描观察控制过程是：

步骤1：实现全方位欠驱动胶囊机器人方位的初始标定：施加旋转磁场的法向量与地面垂直向量n₀一致，基于同轴随动磁矩效应，胶囊机器人轴线n_B最终与旋转磁场法向量保持一致；

步骤2：实现待测环境顶部观察诊断：控制胶囊机器人轴线n_B轨迹与地面垂直向量n₀成一定夹角α的锥面范围内依次运动观察时，基于同轴随动磁矩效应，控制胶囊机器人轴线n_B依次跟随磁场法向量方向进行扫描观察；其中，α的范围为0～90°；

步骤3：实现待测环境底部观察诊断：控制胶囊机器人轴线n_B轨迹与地面垂直向量n₀成一定夹角-α的锥面范围内依次运动观察时，控制胶囊机器人轴线n_B依次跟随磁场法向量方向进行扫描观察。

4.根据权利要求2所述的一种全方位观察欠驱动胶囊机器人的轴线翻转磁控操作方法，其特征在于，全方位观察欠驱动胶囊机器人直线与转弯翻滚行走控制过程是：

步骤1：完成待测环境弯曲方向的视觉检测：控制胶囊机器人轴线n_B轨迹与地面垂直向量n₀成一定夹角±α的锥面范围内依次进行扫描观察，直到基本对待准测环境弯曲方向，并通过视觉定位方法确定待测环境弯曲方向；其中，α的范围为0～90°；

步骤2：在直线待测环境内实现滚动行走：根据步骤1判定的待测环境弯曲方向即为胶囊机器人翻转滚动的行走方向，当直线待测环境滚动向量为n_sa时，在地面垂直向量n₀和直线滚动向量n_sa构成的竖直平面V₁内连续改变旋转磁场法向量n_f方位，即控制胶囊机器人轴线n_B在垂直平面V₁内作连续圆形翻转，实现胶囊机器人在待测环境内部约束下沿直线翻滚行走功能；

步骤3：在弯曲待测环境内实现滚动行走：根据步骤1判定的待测环境弯曲方向即为胶囊机器人翻转滚动的行走方向，当弯曲待测环境弯曲向量为n_sb时，在地面垂直向量n₀和弯曲滚动向量n_sb构成的竖直平面V内连续改变旋转磁场法向量n_f方位，进而控制胶囊机器人轴线n_B在垂直平面V内作连续圆形翻转。

Images