CN113116279A - 磁控胶囊机器人的磁耦合启动控制装置、系统及方法 - Google Patents
磁控胶囊机器人的磁耦合启动控制装置、系统及方法 Download PDFInfo
- Publication number
- CN113116279A CN113116279A CN202110427031.5A CN202110427031A CN113116279A CN 113116279 A CN113116279 A CN 113116279A CN 202110427031 A CN202110427031 A CN 202110427031A CN 113116279 A CN113116279 A CN 113116279A
- Authority
- CN
- China
- Prior art keywords
- magnetic
- capsule robot
- control capsule
- magnetic control
- robot
- 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.)
- Pending
Links
- 239000002775 capsule Substances 0.000 title claims abstract description 246
- 230000008878 coupling Effects 0.000 title claims abstract description 70
- 238000010168 coupling process Methods 0.000 title claims abstract description 70
- 238000005859 coupling reaction Methods 0.000 title claims abstract description 70
- 238000000034 method Methods 0.000 title claims abstract description 20
- 239000012530 fluid Substances 0.000 claims description 62
- 230000009471 action Effects 0.000 claims description 21
- 239000007788 liquid Substances 0.000 claims description 10
- 230000001808 coupling effect Effects 0.000 claims description 8
- 230000005484 gravity Effects 0.000 claims description 8
- 239000002518 antifoaming agent Substances 0.000 claims description 3
- 230000004913 activation Effects 0.000 claims 5
- 230000002829 reductive effect Effects 0.000 description 7
- 238000001514 detection method Methods 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 230000003068 static effect Effects 0.000 description 5
- 241000282414 Homo sapiens Species 0.000 description 4
- 238000003745 diagnosis Methods 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000000903 blocking effect Effects 0.000 description 3
- 201000010099 disease Diseases 0.000 description 3
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 3
- 210000001035 gastrointestinal tract Anatomy 0.000 description 3
- 238000001727 in vivo Methods 0.000 description 3
- 208000028774 intestinal disease Diseases 0.000 description 3
- 230000001360 synchronised effect Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000005034 decoration Methods 0.000 description 2
- 238000009795 derivation Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000000737 periodic effect Effects 0.000 description 2
- 230000002441 reversible effect Effects 0.000 description 2
- 238000010008 shearing Methods 0.000 description 2
- 210000000683 abdominal cavity Anatomy 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 210000001072 colon Anatomy 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 230000036541 health Effects 0.000 description 1
- 238000011065 in-situ storage Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000000968 intestinal effect Effects 0.000 description 1
- 230000000670 limiting effect Effects 0.000 description 1
- 230000014759 maintenance of location Effects 0.000 description 1
- 230000036285 pathological change Effects 0.000 description 1
- 231100000915 pathological change Toxicity 0.000 description 1
- 230000008855 peristalsis Effects 0.000 description 1
- 230000000979 retarding effect Effects 0.000 description 1
- 210000000813 small intestine Anatomy 0.000 description 1
- 238000002627 tracheal intubation Methods 0.000 description 1
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
- A61B1/00133—Drive units for endoscopic tools inserted through or with the endoscope
-
- 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/31—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 rectum, e.g. proctoscopes, sigmoidoscopes, colonoscopes
Abstract
本发明涉及自动化工程技术领域，具体涉及一种磁控胶囊机器人的磁耦合启动控制装置、系统及方法，包括：外部永磁体、步进电机、控制器；外部永磁体设置在步进电机的输出轴上，步进电机由控制器进行控制。步进电机在控制器的控制作用下，并经步进电机中步进电机驱动器的驱动控制，在外部永磁体周围形成旋转磁场，进而形成动态耦合磁力矩，旋转磁场包围嵌有内部永磁体的磁控胶囊机器人，动态耦合磁力矩作用于磁控胶囊机器人，利用磁机耦合作用，依靠磁控胶囊机器人的旋转力与高粘度流体的推动力相互作用并高于磁控胶囊机器人的自启速度时，推动磁控胶囊机器人前进，能够对磁控胶囊机器人进行自启转速控制，无时间响应和判断不准确的问题。
Description
技术领域
本发明涉及自动化工程技术领域，具体而言，涉及一种磁控胶囊机器人的磁耦合启动控制装置、系统及方法。
背景技术
肠道疾病是人类的高发病症，全球仅腹腔疾病的患者数量就已达七千万例。肠道疾病、特别是位于小肠和结肠部分的疾病，对人类公共安全带来了较大危害。无线磁控胶囊机器人的出现是人口健康诊疗领域的重大突破，完全避免了传统插管检查的痛苦，相比传统内窥镜，磁控胶囊机器人提供了一种全新的无创解决方案，医生通过磁控胶囊机器人获得病变组织信息，进行肠道疾病诊断，具有广阔的应用前景。被动磁控胶囊机器人利用消化道蠕动的方式进行遍历诊察，运行速度缓慢，无法实现姿态主动控制，遇到肠道褶皱堆积还会发生长时间滞留人体的危险。而主动式磁控胶囊机器人能够克服上述被动磁控胶囊机器人的缺点，此类磁控胶囊机器人能够实现机器人方向和姿态的主动调整，缩短消化道遍历时间，提高诊疗效率，减少漏检区域，改善诊疗安全性。
目前利用机械手末端执行器安装永磁体驱动磁控胶囊机器人的方法应用较广泛，公开号CN110236474A，名称为“一种主动式磁控胶囊机器人检测系统及检测方法”的专利申请提出利用支撑架及控制台安装驱动磁体引导模块的方式，通过产生磁场对磁控胶囊机器人进行磁引导。然而，使用外部机械手磁体引导磁控胶囊机器人在肠道中运动，对机械手磁体的自由度要求较高。而且，若想利用机械手磁体驱动磁控胶囊机器人运动到目标方位，必须维持机器人内部永磁体和机械手磁体间的有效距离和相对速度，但是机械手的实时性和临场判断能力较难实现对磁控胶囊机器人的快速连续驱动。
发明内容
为解决上述问题，本发明的目的在于提供一种磁控胶囊机器人的磁耦合启动控制装置、系统及方法，能够对磁控胶囊机器人进行自启转速控制，并由人工手持完成磁控胶囊机器人的快速准确操控，无时间响应和判断不准确的问题，使用方便。
本发明的目的是通过以下技术方案实现的：
一方面，本发明提供了一种磁控胶囊机器人的磁耦合启动控制装置，包括：外部永磁体、步进电机、控制器；外部永磁体设置在步进电机的输出轴上，步进电机由控制器进行控制；
步进电机在控制器的控制作用下，并经步进电机中步进电机驱动器的驱动控制，在外部永磁体周围形成旋转磁场，进而形成动态耦合磁力矩，旋转磁场包围嵌有内部永磁体的磁控胶囊机器人，动态耦合磁力矩作用于磁控胶囊机器人，利用磁机耦合作用，依靠磁控胶囊机器人的旋转力与高粘度流体的推动力相互作用并高于磁控胶囊机器人的自启速度时，推动磁控胶囊机器人前进。
进一步地，当外部旋转磁场转速低于磁控胶囊机器人的自启速度时，在粘性液体的阻滞作用下，磁控胶囊机器人只能自转但不会前进；
随着外部旋转磁场转速的增加，磁控胶囊机器人转速随之提高，磁控胶囊机器人开始向前运动，对应的外部旋转磁场转速称为自启转速；
在磁控胶囊机器人启动运行之后，经过其稳态自调整，在自身重力和外部磁场的作用之下，磁控胶囊机器人沿偏移管道中心的方向稳定运行。
进一步地，磁控胶囊机器人沿偏移管道中心的方向稳定运行时，磁控胶囊机器人沿轴线方向运动达到受力平衡态，磁控胶囊机器人轴推力与流体阻力相等，磁控胶囊机器人以稳恒速度前进。
进一步地，外部永磁体为圆环状永磁体。
进一步地，圆环状外部永磁体安装于步进电机轴末端。
进一步地，步进电机在控制器中的Arduino单片机下进行控制作用。
进一步地，外部永磁体为径向充磁。
进一步地，磁控胶囊机器人进行前进推进的管道内部充满医用祛泡剂。
另一方面，本发明提供了一种磁控胶囊机器人的磁耦合系统，包括：包括磁耦合启动控制装置和磁控胶囊机器人，磁耦合启动控制装置为上述任一项的磁耦合启动控制装置。
进一步地，磁控胶囊机器人内嵌有内部永磁体。
再一方面，本发明提供了一种磁控胶囊机器人的磁耦合启动控制方法，包括以下步骤：
当外部旋转磁场转速低于磁控胶囊机器人自启速度时，在粘性液体的阻滞作用下，磁控胶囊机器人只能自转但不会前进；
随着外部旋转磁场转速的增加，磁控胶囊机器人转速随之提高，开始向前运动，对应的外部旋转磁场转速称为自启转速；
在磁控胶囊机器人启动运行之后，经过其稳态自调整，在自身重力和外部磁场的作用之下，磁控胶囊机器人沿偏移管道中心的方向稳定运行。
本发明的磁控胶囊机器人的磁耦合启动控制装置、系统及方法，步进电机在控制器的控制作用下，并经步进电机中步进电机驱动器的驱动控制，在外部永磁体周围形成旋转磁场，进而形成动态耦合磁力矩，旋转磁场包围嵌有内部永磁体的磁控胶囊机器人，动态耦合磁力矩作用于磁控胶囊机器人，利用磁机耦合作用，依靠磁控胶囊机器人的旋转力与高粘度流体的推动力相互作用并高于磁控胶囊机器人的自启速度时，推动磁控胶囊机器人前进，能够对磁控胶囊机器人进行自启转速控制，并由人工手持完成磁控胶囊机器人的快速准确操控，无时间响应和判断不准确的问题，使用方便。
附图说明
此处所说明的附图用来提供对本发明的进一步理解，构成本申请的一部分，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：
图1为本发明的磁控胶囊机器人的磁耦合系统示意图；
图2为本发明的磁控胶囊机器人的磁耦合启动控制装置示意图；
图3为本发明的内外永磁体相对旋转运动原理图；
图4为本发明的磁控胶囊机器人受力动态平衡示意图；
图5为本发明的磁控胶囊机器人动态启动运行示意图；
图6为本发明的磁控胶囊机器人的磁耦合启动控制方法的步骤框图；
其中附图标记为：1、病床；2、患者；3、手持控制装置；4、磁控胶囊机器人；31、外部永磁体；32、联轴器；33、输出轴；34、步进电机；35、控制面板。
具体实施方式
为了使本技术领域的人员更好地理解本发明方案，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分的实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本发明保护的范围。
实施例一
如图1-5所示，本发明实施例的一种磁控胶囊机器人的磁耦合启动控制装置(手持控制装置3)，包括：外部永磁体31、步进电机34、控制器；外部永磁体31设置在步进电机34的输出轴33上，通过联轴器32连接，步进电机34由控制器进行控制，控制器通过控制面板35对步进电机34进行控制；
步进电机34在控制器的控制作用下，并经步进电机34中步进电机34驱动器的驱动控制，在外部永磁体31周围形成旋转磁场，进而形成动态耦合磁力矩，旋转磁场包围嵌有内部永磁体的磁控胶囊机器人4，动态耦合磁力矩作用于磁控胶囊机器人4，利用磁机耦合作用，依靠磁控胶囊机器人4的旋转力与高粘度流体的推动力相互作用并高于磁控胶囊机器人4的自启速度时，推动磁控胶囊机器人4前进。
本发明的磁控胶囊机器人的磁耦合启动控制装置，步进电机34在控制器的控制作用下，并经步进电机34中步进电机34驱动器的驱动控制，在外部永磁体31周围形成旋转磁场，进而形成动态耦合磁力矩，旋转磁场包围嵌有内部永磁体的磁控胶囊机器人4，动态耦合磁力矩作用于磁控胶囊机器人4，利用磁机耦合作用，依靠磁控胶囊机器人4的旋转力与高粘度流体的推动力相互作用并高于磁控胶囊机器人4的自启速度时，推动磁控胶囊机器人4前进，能够对磁控胶囊机器人4进行自启转速控制，并由人工手持完成磁控胶囊机器人4的快速准确操控，无时间响应和判断不准确的问题，使用方便。
其中，当外部旋转磁场转速低于磁控胶囊机器人4的自启速度时，在粘性液体的阻滞作用下，磁控胶囊机器人4只能自转但不会前进；
随着外部旋转磁场转速的增加，磁控胶囊机器人4转速随之提高，磁控胶囊机器人4开始向前运动，对应的外部旋转磁场转速称为自启转速；
在磁控胶囊机器人4启动运行之后，经过其稳态自调整，在自身重力和外部磁场的作用之下，磁控胶囊机器人4沿偏移管道中心的方向稳定运行。
其中，磁控胶囊机器人4沿偏移管道中心的方向稳定运行时，磁控胶囊机器人4沿轴线方向运动达到受力平衡态，磁控胶囊机器人4轴推力与流体阻力相等，磁控胶囊机器人4以稳恒速度前进。
其中，外部永磁体31为圆环状永磁体，形成更稳定的外部旋转磁场。
其中，圆环状外部永磁体31安装于步进电机34轴末端。
其中，步进电机34在控制器中的Arduino单片机下进行控制作用，控制精度更高。
其中，外部永磁体31为径向充磁。
其中，磁控胶囊机器人4进行前进推进的管道内部充满医用祛泡剂，便于形成稳定的阻滞作用，该管道为模拟人体肠道的管道。
下面以具体的实施例，对本发明一种磁控胶囊机器人的磁耦合启动控制装置进行详细说明。该装置包括病床1、患者2、手持控制装置3、磁控胶囊机器人4。
具体地说明下，磁控胶囊机器人4的力平衡关系，流体阻力矩与耦合磁力矩关系，磁控胶囊机器人4的流体阻力的推导过程：
根据磁耦合理论，外部永磁体31与磁控胶囊机器人4内部永磁体的耦合磁力矩垂直于内部永磁体磁矩矢量m与旋转磁场磁矢量B形成的平面，耦合磁力矩Tc为：
Tc＝m×B (1)
磁控胶囊机器人4在外部永磁体31旋转磁场作用下运动时，在启动瞬间或者停止状态时，管内流体阻力矩Tf为零。随着旋转磁场转速的增加，管内流体会产生流体阻力矩Tf，对磁控胶囊机器人4的旋转运动产生阻碍作用，由于阻碍作用的存在，使磁控胶囊机器人4内部永磁体与外部永磁体31之间不能保持完全同步旋转，并形成一个滞后角度，即转差角δ。当磁控胶囊机器人4轴线与旋转磁矢量轴线平行时，式(1)可写成：
Tc＝m·B·sinδ (2)
其中，δ为外部永磁体31旋转磁矢量与内部永磁体磁矩矢量之间的转差角。
如图3所示为外部永磁体31从位置(1)至位置(5)旋转驱动磁控胶囊机器人4内部永磁体的一个周期过程。启动初始时刻，内部永磁体N极与外部永磁体31S极处于相对静止状态，此时的外转差角为零，如图3的位置(1)所示。随着外部永磁体31速度的增加，内部永磁体也被两者之间的耦合磁力矩带动而旋转，由于磁控胶囊机器人4在大粘度管道中，流体的阻滞作用，使内部永磁体较外部永磁体31滞后一个常值转差角C，如图3的位置(2)所示。当达到稳态转速时，内外部永磁体31之间的常值转差角C会一直保持，直至减速停机，其余旋转状态如图3的位置(3)、位置(4)、位置(5)所示。
从磁控胶囊机器人4启动瞬间到稳态旋转过程中，随着转差角的增大，耦合磁力矩也逐渐增大，当流体阻力矩Tf小于耦合磁力矩Tc时：
Tf＜Tc (3)
磁控胶囊机器人4逐渐加速转动，流体阻力矩Tf随着磁控胶囊机器人4旋转速度的增加而变大。当流体阻力矩Tf与耦合磁力矩Tc相等时：
Tf＝Tc (4)
磁控胶囊机器人4达到稳速状态，此时，磁控胶囊机器人4内部永磁体与旋转磁场之间保持同步旋转，转差角δ与流体阻力矩Tf均保持恒定。当旋转磁场减速时，流体阻力矩Tf大于耦合磁力矩Tc，此时有：
Tf>Tc (5)
磁控胶囊机器人4的流体动压力也会降低，进而大粘度流体对磁控胶囊机器人4的阻力矩也会逐渐减小。调节步进电机34反转可实现磁控胶囊机器人4后退运动。
磁控胶囊机器人4在充满大粘度流体的管道中运行时，由于磁控胶囊机器人4的自旋运动，磁控胶囊机器人4外表面附着的螺旋肋推动流体向后沿机器人轴线方向流出，受到流体的剪切力和压力的反作用力，磁控胶囊机器人4沿轴线方向前进，即为轴推力Faxi，在前进过程中受到的流体阻力为Fres，则作用于磁控胶囊机器人4的合力为F＝Faxi-Fres，如图4所示。
启动初始时，Fres＞Faxi，则有F＜0，磁控胶囊机器人4开始由静止状态增速旋转；当磁控胶囊机器人4转速达到自启临界转速时，有Fres＝Faxi，此时F＝0；当磁控胶囊机器人4继续加速直至再次达到Fres＝Faxi状态时，磁控胶囊机器人4沿轴线方向运动达到受力平衡态，轴推力与流体阻力相等，磁控胶囊机器人4以稳恒速度前进，即有：
Faxi＝Fres (6)
此时磁控胶囊机器人4的稳恒前进速度为Uc。流体阻力大小与磁控胶囊机器人4形状、速度、迎流面积以及流体本身特性，如粘滞性和压缩性等因素有关。因此，磁控胶囊机器人4的流体阻力可表示成：
其中，CD为阻力系数，A为机器人迎流投影面积，即阻力面积。
磁控胶囊机器人在流体中运动时，流体阻力也与雷诺数和磁控胶囊机器人外部形状直接相关。当雷诺数较低时，与轴推力相关的粘性力为主要影响因素，并忽略惯性力的影响。圆形管道中，雷诺数为：
其中，D为管道直径，ρ为流体密度，μ为流体动力μ＝0.5Pa·s粘度。由于磁控胶囊机器人运动速度较低，圆管直径较小，动力粘度，因此，Re＜1。进而可得到由斯托克斯公式推导的粘性流体中机器人流体阻力：
Fres＝3πμdUc (9)
其中，d为机器人半球形头部的直径。综合上式，可以得到阻力系数为：
最终可整理得出磁控胶囊机器人的流体阻力为：
首先，当外部旋转磁场转速较低且低于磁控胶囊机器人4自启速度时，在粘性液体的阻滞作用下，磁控胶囊机器人4只能自转但不会前进；然后，随着外部旋转磁场转速的增加，磁控胶囊机器人4转速随之提高，磁控胶囊机器人4开始向前运动，对应的外部旋转磁场转速称为自启转速；在磁控胶囊机器人4启动运行之后，经过较短时间的稳态自调整，在自身重力和外部磁场的作用之下，磁控胶囊机器人4沿偏移管道中心的方向稳定运行，如图5所示。
本发明由步进电机34的输出轴33末端圆环状永磁体旋转形成动态旋转磁场，与磁控胶囊机器人4内部永磁体的磁耦合作用驱动磁控胶囊机器人4旋转启动运行。当外部旋转磁场转速较低且低于磁控胶囊机器人4自启速度时，在粘性液体的阻滞作用下，机器人只能自转但不会前进。随着外部旋转磁场转速的增加，磁控胶囊机器人4转速随之提高，磁控胶囊机器人4开始向前运动。通过控制磁控胶囊机器人4的自启转速，可实现磁控胶囊机器人4的低扭矩、大轴推力的驱动控制，为体内医疗磁控胶囊机器人4的低功率消耗和快速检测奠定了临床应用基础。
实施例二
如图1-5所示，本发明实施例的一种磁控胶囊机器人的磁耦合系统，包括：磁耦合启动控制装置和磁控胶囊机器人4，磁耦合启动控制装置为上述任一项的磁耦合启动控制装置。
本发明的磁控胶囊机器人的磁耦合系统，步进电机34在控制器的控制作用下，并经步进电机34中步进电机34驱动器的驱动控制，在外部永磁体31周围形成旋转磁场，进而形成动态耦合磁力矩，旋转磁场包围嵌有内部永磁体的磁控胶囊机器人4，动态耦合磁力矩作用于磁控胶囊机器人4，利用磁机耦合作用，依靠磁控胶囊机器人4的旋转力与高粘度流体的推动力相互作用并高于磁控胶囊机器人4的自启速度时，推动磁控胶囊机器人4前进，能够对磁控胶囊机器人4进行自启转速控制，并由人工手持完成磁控胶囊机器人4的快速准确操控，无时间响应和判断不准确的问题，使用方便。
其中，磁控胶囊机器人4内嵌有内部永磁体。
实施例三
如图6所示，本发明实施例的一种磁控胶囊机器人的磁耦合启动控制方法，该方法包括以下步骤：
步骤S1：当外部旋转磁场转速较低且低于磁控胶囊机器人4自启速度时，在粘性液体的阻滞作用下，磁控胶囊机器人4只能自转但不会前进。启动初始时，流体阻力Fres＞轴推力Faxi，则有合力F＝Faxi－Fres＜0，机器人开始由静止状态增速旋转。
步骤S2：随着外部旋转磁场转速的增加，磁控胶囊机器人4转速随之提高，开始向前运动，对应的外部旋转磁场转速称为自启转速。当机器人转速达到自启转速时，有Fres＝Faxi，此时F＝0。
步骤S3：在磁控胶囊机器人4启动运行之后，经过较短时间的稳态自调整，在自身重力和外部磁场的作用之下，磁控胶囊机器人4沿偏移管道中心的方向稳定运行。此时磁控胶囊机器人4沿轴线方向运动达到受力平衡态，达到Fres＝Faxi状态，磁控胶囊机器人4轴推力与流体阻力相等，以稳恒速度前进。
下面以具体的实施例，对本发明一种磁控胶囊机器人的磁耦合启动控制方法进行详细说明。其对应的装置包括病床1、患者2、手持控制装置3、磁控胶囊机器人4。
具体地说明下，磁控胶囊机器人4的力平衡关系，流体阻力矩与耦合磁力矩关系，磁控胶囊机器人4的流体阻力的推导过程：
根据磁耦合理论，外部永磁体31与磁控胶囊机器人4内部永磁体的耦合磁力矩垂直于内部永磁体磁矩矢量m与旋转磁场磁矢量B形成的平面，耦合磁力矩Tc为：
Tc＝m×B (1)
磁控胶囊机器人4在外部永磁体31旋转磁场作用下运动时，在启动瞬间或者停止状态时，管内流体阻力矩Tf为零。随着旋转磁场转速的增加，管内流体会产生流体阻力矩Tf，对磁控胶囊机器人4的旋转运动产生阻碍作用，由于阻碍作用的存在，使磁控胶囊机器人4内部永磁体与外部永磁体31之间不能保持完全同步旋转，并形成一个滞后角度，即转差角δ。当磁控胶囊机器人4轴线与旋转磁矢量轴线平行时，式(1)可写成：
Tc＝m·B·sinδ (2)
其中，δ为外部永磁体31旋转磁矢量与内部永磁体磁矩矢量之间的转差角。
如图3所示为外部永磁体31从位置(1)至位置(5)旋转驱动磁控胶囊机器人4内部永磁体的一个周期过程。启动初始时刻，内部永磁体N极与外部永磁体31S极处于相对静止状态，此时的外转差角为零，如图3的位置(1)所示。随着外部永磁体31速度的增加，内部永磁体也被两者之间的耦合磁力矩带动而旋转，由于磁控胶囊机器人4在大粘度管道中，流体的阻滞作用，使内部永磁体较外部永磁体31滞后一个常值转差角C，如图3的位置(2)所示。当达到稳态转速时，内外部永磁体31之间的常值转差角C会一直保持，直至减速停机，其余旋转状态如图3的位置(3)、位置(4)、位置(5)所示。
从磁控胶囊机器人4启动瞬间到稳态旋转过程中，随着转差角的增大，耦合磁力矩也逐渐增大，当流体阻力矩Tf小于耦合磁力矩Tc时：
Tf＜Tc (3)
磁控胶囊机器人4逐渐加速转动，流体阻力矩Tf随着磁控胶囊机器人4旋转速度的增加而变大。当流体阻力矩Tf与耦合磁力矩Tc相等时：
Tf＝Tc (4)
磁控胶囊机器人4达到稳速状态，此时，磁控胶囊机器人4内部永磁体与旋转磁场之间保持同步旋转，转差角δ与流体阻力矩Tf均保持恒定。当旋转磁场减速时，流体阻力矩Tf大于耦合磁力矩Tc，此时有：
Tf>Tc (5)
磁控胶囊机器人4的流体动压力也会降低，进而大粘度流体对磁控胶囊机器人4的阻力矩也会逐渐减小。调节步进电机34反转可实现磁控胶囊机器人4后退运动。
磁控胶囊机器人4在充满大粘度流体的管道中运行时，由于磁控胶囊机器人4的自旋运动，磁控胶囊机器人4外表面附着的螺旋肋推动流体向后沿机器人轴线方向流出，受到流体的剪切力和压力的反作用力，磁控胶囊机器人4沿轴线方向前进，即为轴推力Faxi，在前进过程中受到的流体阻力为Fres，则作用于磁控胶囊机器人4的合力为F＝Faxi-Fres，如图4所示。
启动初始时，Fres＞Faxi，则有F＜0，磁控胶囊机器人4开始由静止状态增速旋转；当磁控胶囊机器人4转速达到自启临界转速时，有Fres＝Faxi，此时F＝0；当磁控胶囊机器人4继续加速直至再次达到Fres＝Faxi状态时，磁控胶囊机器人4沿轴线方向运动达到受力平衡态，轴推力与流体阻力相等，磁控胶囊机器人4以稳恒速度前进，即有：
Faxi＝Fres (6)
此时磁控胶囊机器人4的稳恒前进速度为Uc。流体阻力大小与磁控胶囊机器人4形状、速度、迎流面积以及流体本身特性，如粘滞性和压缩性等因素有关。因此，磁控胶囊机器人4的流体阻力可表示成：
其中，CD为阻力系数，A为机器人迎流投影面积，即阻力面积。
磁控胶囊机器人在流体中运动时，流体阻力也与雷诺数和磁控胶囊机器人外部形状直接相关。当雷诺数较低时，与轴推力相关的粘性力为主要影响因素，并忽略惯性力的影响。圆形管道中，雷诺数为：
其中，D为管道直径，ρ为流体密度，μ为流体动力粘度。由于磁控胶囊机器人运动速度较低，圆管直径较小，动力粘度μ＝0.5Pa·s，因此，Re＜1。进而可得到由斯托克斯公式推导的粘性流体中机器人流体阻力：
Fres＝3πμdUc (9)
其中，d为机器人半球形头部的直径。综合上式，可以得到阻力系数为：
最终可整理得出磁控胶囊机器人的流体阻力为：
首先，当外部旋转磁场转速较低且低于磁控胶囊机器人4自启速度时，在粘性液体的阻滞作用下，磁控胶囊机器人4只能自转但不会前进；然后，随着外部旋转磁场转速的增加，磁控胶囊机器人4转速随之提高，磁控胶囊机器人4开始向前运动，对应的外部旋转磁场转速称为自启转速；在磁控胶囊机器人4启动运行之后，经过较短时间的稳态自调整，在自身重力和外部磁场的作用之下，磁控胶囊机器人4沿偏移管道中心的方向稳定运行，如图5所示。
本发明由步进电机34的输出轴33末端圆环状永磁体旋转形成动态旋转磁场，与磁控胶囊机器人4内部永磁体的磁耦合作用驱动磁控胶囊机器人4旋转启动运行。当外部旋转磁场转速较低且低于磁控胶囊机器人4自启速度时，在粘性液体的阻滞作用下，机器人只能自转但不会前进。随着外部旋转磁场转速的增加，磁控胶囊机器人4转速随之提高，磁控胶囊机器人4开始向前运动。通过控制磁控胶囊机器人4的自启转速，可实现磁控胶囊机器人4的低扭矩、大轴推力的驱动控制，为体内医疗磁控胶囊机器人4的低功率消耗和快速检测奠定了临床应用基础。
本发明的有益效果至少在于：
基于内外永磁体相对旋转运动原理分析机器人自启特性，确定磁控胶囊机器人4自启转速与流体粘度和轴推力之间的关系，可有效降低磁控胶囊机器人4的自启转速条件，显著提高机器人驱动灵活性。通过控制在大粘度流体下机器人的自启转速，可实现机器人的低扭矩、大轴推力的驱动控制，为体内医疗磁控胶囊机器人4的低功率消耗和快速检测奠定了临床应用基础。
以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。
Claims (10)
1.一种磁控胶囊机器人的磁耦合启动控制装置，其特征在于，包括外部永磁体、步进电机、控制器；所述外部永磁体设置在所述步进电机的输出轴上，所述步进电机由所述控制器进行控制；
所述步进电机在所述控制器的控制作用下，并经所述步进电机中步进电机驱动器的驱动控制，在所述外部永磁体周围形成旋转磁场，进而形成动态耦合磁力矩，旋转磁场包围嵌有内部永磁体的所述磁控胶囊机器人，动态耦合磁力矩作用于所述磁控胶囊机器人，利用磁机耦合作用，依靠所述磁控胶囊机器人的旋转力与高粘度流体的推动力相互作用并高于所述磁控胶囊机器人的自启速度时，推动所述磁控胶囊机器人前进。
2.根据权利要求1所述的磁控胶囊机器人的磁耦合启动控制装置，其特征在于，当外部旋转磁场转速低于所述磁控胶囊机器人的自启速度时，在粘性液体的阻滞作用下，所述磁控胶囊机器人只能自转但不会前进；
随着外部旋转磁场转速的增加，所述磁控胶囊机器人转速随之提高，所述磁控胶囊机器人开始向前运动，对应的外部旋转磁场转速称为自启转速；
在所述磁控胶囊机器人启动运行之后，经过其稳态自调整，在自身重力和外部磁场的作用之下，所述磁控胶囊机器人沿偏移管道中心的方向稳定运行。
3.根据权利要求2所述的磁控胶囊机器人的磁耦合启动控制装置，其特征在于，所述磁控胶囊机器人沿偏移管道中心的方向稳定运行时，所述磁控胶囊机器人沿轴线方向运动达到受力平衡态，所述磁控胶囊机器人轴推力与流体阻力相等，所述磁控胶囊机器人以稳恒速度前进。
4.根据权利要求1所述的磁控胶囊机器人的磁耦合启动控制装置，其特征在于，所述外部永磁体为圆环状永磁体。
5.根据权利要求4所述的磁控胶囊机器人的磁耦合启动控制装置，其特征在于，圆环状所述外部永磁体安装于所述步进电机轴末端。
6.根据权利要求1所述的磁控胶囊机器人的磁耦合启动控制装置，其特征在于，所述外部永磁体为径向充磁。
7.根据权利要求1所述的磁控胶囊机器人的磁耦合启动控制装置，其特征在于，所述磁控胶囊机器人进行前进推进的管道内部充满医用祛泡剂。
8.一种磁控胶囊机器人的磁耦合系统，其特征在于，包括磁耦合启动控制装置和磁控胶囊机器人，所述磁耦合启动控制装置为权利要求1-7任一项所述的磁耦合启动控制装置。
9.根据权利要求8所述的磁控胶囊机器人的磁耦合系统，其特征在于，所述磁控胶囊机器人内嵌有内部永磁体。
10.一种磁控胶囊机器人的磁耦合启动控制方法，其特征在于，包括以下步骤：
当外部旋转磁场转速低于磁控胶囊机器人自启速度时，在粘性液体的阻滞作用下，磁控胶囊机器人只能自转但不会前进；
随着外部旋转磁场转速的增加，磁控胶囊机器人转速随之提高，开始向前运动，对应的外部旋转磁场转速称为自启转速；
在磁控胶囊机器人启动运行之后，经过其稳态自调整，在自身重力和外部磁场的作用之下，磁控胶囊机器人沿偏移管道中心的方向稳定运行。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110427031.5A CN113116279A (zh) | 2021-04-20 | 2021-04-20 | 磁控胶囊机器人的磁耦合启动控制装置、系统及方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110427031.5A CN113116279A (zh) | 2021-04-20 | 2021-04-20 | 磁控胶囊机器人的磁耦合启动控制装置、系统及方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN113116279A true CN113116279A (zh) | 2021-07-16 |
Family
ID=76778611
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110427031.5A Pending CN113116279A (zh) | 2021-04-20 | 2021-04-20 | 磁控胶囊机器人的磁耦合启动控制装置、系统及方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113116279A (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113116278A (zh) * | 2021-04-20 | 2021-07-16 | 河南工学院 | 胶囊机器人的磁耦合控制装置、系统及方法 |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20080300458A1 (en) * | 2004-06-21 | 2008-12-04 | Byung Kyu Kim | Capsule Type Endoscope Control System |
| US20130041217A1 (en) * | 2011-01-28 | 2013-02-14 | Olympus Medical Systems Corp. | Capsule medical device guiding system and magnetic field generating device |
| CN104764586A (zh) * | 2015-04-03 | 2015-07-08 | 大连理工大学 | 一种螺旋胶囊机器人液体阻力矩的非接触在线测量方法 |
| EP2995240A1 (en) * | 2014-09-15 | 2016-03-16 | Ankon Medical Technologie (Shanghai) Co., Ltd | Apparatus and method for controlling the movement of a capsule endoscope in the digestive tract of a human body |
| CN208492032U (zh) * | 2017-12-04 | 2019-02-15 | 湖北大学 | 一种基于磁主动控制法的胶囊内窥镜装置 |
| CN208837887U (zh) * | 2017-11-22 | 2019-05-10 | 湖北大学 | 一种外部永磁体同轴控制磁性螺旋型胶囊内窥镜装置 |
| CN110101356A (zh) * | 2019-06-03 | 2019-08-09 | 河南工学院 | 一种胶囊机器人的流体扭转力矩的非接触检测方法及系统 |
| CN211749482U (zh) * | 2019-12-25 | 2020-10-27 | 江苏势通生物科技有限公司 | 磁性螺旋型胶囊内镜及该胶囊内镜的控制系统 |
| CN216495218U (zh) * | 2021-04-20 | 2022-05-13 | 河南工学院 | 磁控胶囊机器人的磁耦合启动控制装置及磁耦合系统 |
-
2021
- 2021-04-20 CN CN202110427031.5A patent/CN113116279A/zh active Pending
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20080300458A1 (en) * | 2004-06-21 | 2008-12-04 | Byung Kyu Kim | Capsule Type Endoscope Control System |
| US20130041217A1 (en) * | 2011-01-28 | 2013-02-14 | Olympus Medical Systems Corp. | Capsule medical device guiding system and magnetic field generating device |
| EP2995240A1 (en) * | 2014-09-15 | 2016-03-16 | Ankon Medical Technologie (Shanghai) Co., Ltd | Apparatus and method for controlling the movement of a capsule endoscope in the digestive tract of a human body |
| CN104764586A (zh) * | 2015-04-03 | 2015-07-08 | 大连理工大学 | 一种螺旋胶囊机器人液体阻力矩的非接触在线测量方法 |
| CN208837887U (zh) * | 2017-11-22 | 2019-05-10 | 湖北大学 | 一种外部永磁体同轴控制磁性螺旋型胶囊内窥镜装置 |
| CN208492032U (zh) * | 2017-12-04 | 2019-02-15 | 湖北大学 | 一种基于磁主动控制法的胶囊内窥镜装置 |
| CN110101356A (zh) * | 2019-06-03 | 2019-08-09 | 河南工学院 | 一种胶囊机器人的流体扭转力矩的非接触检测方法及系统 |
| CN211749482U (zh) * | 2019-12-25 | 2020-10-27 | 江苏势通生物科技有限公司 | 磁性螺旋型胶囊内镜及该胶囊内镜的控制系统 |
| CN216495218U (zh) * | 2021-04-20 | 2022-05-13 | 河南工学院 | 磁控胶囊机器人的磁耦合启动控制装置及磁耦合系统 |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113116278A (zh) * | 2021-04-20 | 2021-07-16 | 河南工学院 | 胶囊机器人的磁耦合控制装置、系统及方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN216495218U (zh) | 磁控胶囊机器人的磁耦合启动控制装置及磁耦合系统 | |
| CN102048517B (zh) | 螺杆式主动推进胶囊机器人 | |
| US5762599A (en) | Magnetically-coupled implantable medical devices | |
| US8944748B2 (en) | Fluid pump changeable in diameter, in particular for medical application | |
| CN100450729C (zh) | 外磁场控制微机器人运动及位姿系统及其控制方法与应用 | |
| EP0823026A1 (en) | Medical fluid pump | |
| CN113116279A (zh) | 磁控胶囊机器人的磁耦合启动控制装置、系统及方法 | |
| JPH0576592A (ja) | 心臓扶助装置や、人工心臓の電気流体式エネルギ変換装置 | |
| CN111772688A (zh) | 一种磁控主动运动活检胶囊机器人及其工作方法 | |
| CN201912084U (zh) | 螺杆式主动推进胶囊机器人 | |
| CN204618172U (zh) | 基于磁主动控制法的手持式胶囊内窥镜控制装置 | |
| CN103393389B (zh) | 内窥镜微型胶囊机器人 | |
| Zheng et al. | A multi-functional module-based capsule robot | |
| Kim et al. | A pushing force mechanism of magnetic spiral-type machine for wireless medical-robots in therapy and diagnosis | |
| Kim et al. | The flexible caterpillar based robotic colonoscope actuated by an external motor through a flexible shaft | |
| EP4023175A2 (en) | Microrobot and microrobot system including same | |
| CN104434008B (zh) | 内窥镜机器人 | |
| CN110604536A (zh) | 一种胶囊机器人磁驱动和测量系统 | |
| CN107007894B (zh) | 一种超声直线电机驱动的可植入式搏动血泵 | |
| Zhang et al. | Design of a novel biopsy capsule robot with anchoring function for intestinal tract | |
| CN215017030U (zh) | 胶囊机器人的磁耦合控制装置及磁耦合系统 | |
| Ye et al. | Research on coaxial control of magnetic spiral-type capsule endoscope | |
| Guo et al. | Study on the active movement capsule robot for biopsy | |
| Wang et al. | Design and testing of a novel gastrointestinal microrobot | |
| JP2013520261A (ja) | 潅流ポンプ用液圧脈動装置 |
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 |