CN114131580B - 可驱动软体机器人及其制备方法、形状感知方法及系统 - Google Patents
可驱动软体机器人及其制备方法、形状感知方法及系统 Download PDFInfo
- Publication number
- CN114131580B CN114131580B CN202111648202.3A CN202111648202A CN114131580B CN 114131580 B CN114131580 B CN 114131580B CN 202111648202 A CN202111648202 A CN 202111648202A CN 114131580 B CN114131580 B CN 114131580B
- Authority
- CN
- China
- Prior art keywords
- drivable
- hose
- mode sensing
- soft robot
- optical fiber
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000002360 preparation method Methods 0.000 title claims abstract description 8
- 239000013307 optical fiber Substances 0.000 claims abstract description 99
- 230000008569 process Effects 0.000 claims abstract description 14
- 239000000696 magnetic material Substances 0.000 claims abstract description 13
- 229920005570 flexible polymer Polymers 0.000 claims abstract description 10
- 230000003287 optical effect Effects 0.000 claims abstract description 8
- 230000008054 signal transmission Effects 0.000 claims abstract description 7
- 230000000149 penetrating effect Effects 0.000 claims abstract description 4
- 239000000463 material Substances 0.000 claims description 22
- 238000009826 distribution Methods 0.000 claims description 15
- 238000005452 bending Methods 0.000 claims description 9
- 239000004205 dimethyl polysiloxane Substances 0.000 claims description 8
- 229920000435 poly(dimethylsiloxane) Polymers 0.000 claims description 8
- 230000005540 biological transmission Effects 0.000 claims description 7
- 239000000243 solution Substances 0.000 claims description 7
- 230000008878 coupling Effects 0.000 claims description 6
- 238000010168 coupling process Methods 0.000 claims description 6
- 238000005859 coupling reaction Methods 0.000 claims description 6
- 238000001723 curing Methods 0.000 claims description 6
- 238000013507 mapping Methods 0.000 claims description 6
- 239000000843 powder Substances 0.000 claims description 6
- NIXOWILDQLNWCW-UHFFFAOYSA-N 2-Propenoic acid Natural products OC(=O)C=C NIXOWILDQLNWCW-UHFFFAOYSA-N 0.000 claims description 5
- HRPVXLWXLXDGHG-UHFFFAOYSA-N Acrylamide Chemical compound NC(=O)C=C HRPVXLWXLXDGHG-UHFFFAOYSA-N 0.000 claims description 5
- 239000003999 initiator Substances 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 claims description 5
- 238000002156 mixing Methods 0.000 claims description 5
- 238000000016 photochemical curing Methods 0.000 claims description 5
- -1 polydimethylsiloxane Polymers 0.000 claims description 5
- IJGRMHOSHXDMSA-UHFFFAOYSA-N Atomic nitrogen Chemical compound N#N IJGRMHOSHXDMSA-UHFFFAOYSA-N 0.000 claims description 4
- LFQSCWFLJHTTHZ-UHFFFAOYSA-N Ethanol Chemical compound CCO LFQSCWFLJHTTHZ-UHFFFAOYSA-N 0.000 claims description 4
- 239000008367 deionised water Substances 0.000 claims description 4
- 229910021641 deionized water Inorganic materials 0.000 claims description 4
- 239000006249 magnetic particle Substances 0.000 claims description 4
- 239000011259 mixed solution Substances 0.000 claims description 4
- 239000000178 monomer Substances 0.000 claims description 4
- 229910001172 neodymium magnet Inorganic materials 0.000 claims description 4
- 239000013598 vector Substances 0.000 claims description 4
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Chemical compound O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 4
- 229920002818 (Hydroxyethyl)methacrylate Polymers 0.000 claims description 3
- SMZOUWXMTYCWNB-UHFFFAOYSA-N 2-(2-methoxy-5-methylphenyl)ethanamine Chemical compound COC1=CC=C(C)C=C1CCN SMZOUWXMTYCWNB-UHFFFAOYSA-N 0.000 claims description 3
- WOBHKFSMXKNTIM-UHFFFAOYSA-N Hydroxyethyl methacrylate Chemical compound CC(=C)C(=O)OCCO WOBHKFSMXKNTIM-UHFFFAOYSA-N 0.000 claims description 3
- WHNWPMSKXPGLAX-UHFFFAOYSA-N N-Vinyl-2-pyrrolidone Chemical compound C=CN1CCCC1=O WHNWPMSKXPGLAX-UHFFFAOYSA-N 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims description 3
- 230000002209 hydrophobic effect Effects 0.000 claims description 3
- 229910052757 nitrogen Inorganic materials 0.000 claims description 3
- 238000004140 cleaning Methods 0.000 claims description 2
- 239000000084 colloidal system Substances 0.000 claims description 2
- 238000011010 flushing procedure Methods 0.000 claims description 2
- 239000002245 particle Substances 0.000 claims description 2
- 238000002791 soaking Methods 0.000 claims description 2
- 239000000126 substance Substances 0.000 claims description 2
- 230000001131 transforming effect Effects 0.000 claims description 2
- 239000000835 fiber Substances 0.000 description 18
- 230000007613 environmental effect Effects 0.000 description 8
- 230000008859 change Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 230000001276 controlling effect Effects 0.000 description 4
- QJVKUMXDEUEQLH-UHFFFAOYSA-N [B].[Fe].[Nd] Chemical compound [B].[Fe].[Nd] QJVKUMXDEUEQLH-UHFFFAOYSA-N 0.000 description 3
- 239000003795 chemical substances by application Substances 0.000 description 3
- 230000005855 radiation Effects 0.000 description 3
- 239000002994 raw material Substances 0.000 description 3
- 239000011257 shell material Substances 0.000 description 3
- 229920005839 ecoflex® Polymers 0.000 description 2
- 229920001971 elastomer Polymers 0.000 description 2
- 239000000806 elastomer Substances 0.000 description 2
- SZVJSHCCFOBDDC-UHFFFAOYSA-N ferrosoferric oxide Chemical compound O=[Fe]O[Fe]O[Fe]=O SZVJSHCCFOBDDC-UHFFFAOYSA-N 0.000 description 2
- 238000003384 imaging method Methods 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 230000005415 magnetization Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000000877 morphologic effect Effects 0.000 description 2
- 230000001105 regulatory effect Effects 0.000 description 2
- 229920001935 styrene-ethylene-butadiene-styrene Polymers 0.000 description 2
- 229920002803 thermoplastic polyurethane Polymers 0.000 description 2
- 229920001634 Copolyester Polymers 0.000 description 1
- VYPSYNLAJGMNEJ-UHFFFAOYSA-N Silicium dioxide Chemical compound O=[Si]=O VYPSYNLAJGMNEJ-UHFFFAOYSA-N 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 239000002390 adhesive tape Substances 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000903 blocking effect Effects 0.000 description 1
- 210000000988 bone and bone Anatomy 0.000 description 1
- 229910052796 boron Inorganic materials 0.000 description 1
- MTAZNLWOLGHBHU-UHFFFAOYSA-N butadiene-styrene rubber Chemical class C=CC=C.C=CC1=CC=CC=C1 MTAZNLWOLGHBHU-UHFFFAOYSA-N 0.000 description 1
- 239000011248 coating agent Substances 0.000 description 1
- 238000000576 coating method Methods 0.000 description 1
- 238000002591 computed tomography Methods 0.000 description 1
- 239000002872 contrast media Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 239000003292 glue Substances 0.000 description 1
- 210000003128 head Anatomy 0.000 description 1
- 239000000017 hydrogel Substances 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 210000004072 lung Anatomy 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
- 238000002168 optical frequency-domain reflectometry Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 229920000642 polymer Polymers 0.000 description 1
- 229920002635 polyurethane Polymers 0.000 description 1
- 239000004814 polyurethane Substances 0.000 description 1
- 239000000741 silica gel Substances 0.000 description 1
- 229910002027 silica gel Inorganic materials 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
- 238000003756 stirring Methods 0.000 description 1
- 229920003048 styrene butadiene rubber Polymers 0.000 description 1
- 238000002627 tracheal intubation Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J7/00—Micromanipulators
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Mechanical Engineering (AREA)
- Surgery (AREA)
- Heart & Thoracic Surgery (AREA)
- Biomedical Technology (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Medical Informatics (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种可驱动软体机器人及其制备方法、形状感知方法及系统，其中，该可驱动软体机器人包括：可驱动软管和形态感知模块，可驱动软管为混合有磁性材料的柔性聚合物制备而成的均匀连续结构；形状感知模块包括穿透所述可驱动软管中的N根单模传感光纤，N根单模传感光纤构成正N棱柱，正N棱柱的中心轴与可驱动软管的中心轴重叠，所述单模传感光纤用于接收光纤中光信号传播过程中的瑞利后向散射波段。可驱动软管内掺杂有磁性材料，可通过外部磁控装置灵活控制机器人各个部位的形变，具有全方位方向控制能力，可以减小在递送过程中对内部结构的损害。
Description
技术领域
本发明属于小型机器人技术领域，更具体地，涉及一种可驱动软体机器人及其制备方法、形状感知方法及系统。
背景技术
在现有的医疗领域中，手术插管过程中普遍做法是依靠医学影像或其他灰度图像的监控和引导，其中超声成像清晰度低、分辨力有限，且受空气影响不易用于观察肺部、骨骼及头部；计算机断层扫描会导致患者面临极大的磁辐射，且无法多平面成像；造影成像则需要注入大量造影剂同时也会受到一定量的辐射，过程较复杂。而光纤重构技术具有无辐射、实时获取软体机器人的真实形态、不受电磁干扰等优势，因此，基于光纤重构的小型机器人被普遍适用于医疗领域。但是，现有机器人普遍是基于气动或液压驱动，机器人本身被严重束缚，驱动过程复杂且难以精确控制，这限制了它们在通常需要无束缚驱动的实际医疗应用中的使用。
发明内容
针对现有技术的以上缺陷或改进需求，本发明提供了一种可驱动软体机器人及其制备方法、形状感知方法及系统，其目的在于简化机器人的结构并提高驱动的可控性，由此解决驱动过程复杂且难以精确控制的技术问题。
为实现上述目的，按照本发明的第一个方面，提供了一种可驱动软体机器人，其包括：
可驱动软管，为混合有磁性材料的柔性聚合物制备而成的均匀连续结构；
形状感知模块，包括穿透所述可驱动软管的N根单模传感光纤，N根单模传感光纤构成正N棱柱，正N棱柱的中心轴与可驱动软管的中心轴重叠，所述单模传感光纤用于接收光纤中光信号传播过程中的瑞利后向散射波段，N≥3。
在其中一些实施例中，所述柔性聚合物包括PDMS、TPU、SEBS、Ecoflex中的任一种，所述磁性材料包括磁性颗粒钕铁硼粉末或四氧化三铁粉末。
在其中一些实施例中，还包括：
功能性外壳模块，包覆于所述可驱动软管外表面，所述功能性外壳模块的材料包括丙烯酰胺、丙烯酸、N，N-二甲基丙烯酰胺、甲基丙烯酸羟乙酯、N-乙烯基吡咯烷酮中的任一种。
在其中一些实施例中，还包括：
磁控设备，用于控制所述可驱动软管各部分的自由运动。
按照本发明的第二个方面，提供了一种可驱动软体机器人制备方法，其包括：
将磁性材料和柔性聚合物混合，形成混合材料；
将所述混合材料倒入模具，制备可驱动软管，所述可驱动软管中预留有N个光纤输入孔；
对可驱动软管置于磁场中进行磁化；
将N根单模传感光纤分别嵌入对应的光纤输入孔，得到可驱动软体机器人，其中，N根单模传感光纤构成正N棱柱，正N棱柱的中心轴与可驱动软管的中心轴重叠，所述单模传感光纤用于接收光纤中光信号传播过程中的瑞利后向散射波段，N≥3。
按照本发明的第三个方面，提供了一种可驱动软体机器人的形状感知方法，其包括：
将可驱动软体机器人的一端作为固定端固定，另一端作为自由端送进目标对象内，所述可驱动软体机器人为上述任一项所述的可驱动软体机器人；
建立空间坐标系，记录固定端的初始坐标，利用形态感知模块重构出进入目标对象后可驱动软体机器人各横截面中心点的初始坐标；
通过外部磁场控制可驱动软体机器人各部分扭动以使可驱动软体机器人发生形变；
利用形态感知模块重构出形变期间可驱动软体机器人各横截面中心点的当前坐标，获得可驱动软体机器人的当前整体形状。
在其中一些实施例中，利用形态感知模块重构出可驱动软体机器人各横截面中心点的坐标，包括
获取每根单模传感光纤的波长漂移信息；
根据波长漂移信息与可驱动软管的材料之间的应变耦合传递系统映射关系，计算在可驱动软管各横截面s上的第i根单模传感光纤的应变信息εi(s)；
获取每根单模传感光纤的分布信息，所述分布信息包括第i根单模传感光纤与可驱动软管中心轴之间的距离ri，以及可驱动软管横截面中第1根单模传感光纤与第i根单模传感光纤之间的夹角
根据每根单模传感光纤的应变信息和每根单模传感光纤的分布信息，计算可驱动软管各横截面s的曲率k(s)和挠率τ(s)；
根据曲率k(s)和挠率τ(s)计算出各横截面s的中心坐标γ(s)。
在其中一些实施例中，计算可驱动软管各横截面s的曲率k(s)和挠率τ(s)，包括：
构建应变信息εi(s)与曲率k(s)、挠率τ(s)的第一关系式： 其中，θ1(s)表示在横截面s上的任一根单模传感光纤与中心轴的连接线与曲率方向的夹角；
将第一关系式变形为记为矩阵ε(s)＝Mψ(s)；
计算横截面s的曲率k(s)和挠率τ(s)，其中， θ1(s)＝arctan(ψ2(s)，ψ1(s))，ψ1(s)＝cos(θ1(s))，ψ2(s)＝sin(θ1(s))。
在其中一些实施例中，根据曲率k(s)和挠率τ(s)计算出各横截面s的中心坐标γ(s)，包括：
构建坐标γ(s)与曲率k(s)和挠率τ(s)的第二关系式：
其中，T(s)、N(s)和B(s)分别表示可驱动软管在γ(s)处的切向量、法向量和副法向量；
根据所述第二关系式计算各横截面s的中心坐标γ(s)。
按照本发明的第四个方面，提供了一种可驱动软体机器人的形状感知系统，其特征在于，用于感知上述任一项所述的可驱动软体机器人在目标对象内部的当前整体形状，所述形态感知系统包括：
波长漂移信息感知单元，用于获取每根单模传感光纤的波长漂移信息；
应变信息计算单元，用于根据波长漂移信息与可驱动软管的材料之间的应变耦合传递系统映射关系，计算在可驱动软管各横截面上的第i根单模传感光纤的应变信息εi(s)；
曲率和挠率计算单元，用于根据每根单模传感光纤的应变信息和每根单模传感光纤的分布信息，计算可驱动软管各横截面s的曲率k(s)和挠率τ(s)，其中，所述分布信息包括第i根单模传感光纤与可驱动软管中心轴之间的距离ri，以及可驱动软管横截面中第1根单模传感光纤与第i根单模传感光纤之间的夹角
形态重构单元，用于根据曲率k(s)和挠率τ(s)计算出各横截面s的中心坐标γ(s)，并基于各横截面s的中心坐标γ(s)重构可驱动软体机器人的当前整体形状。
总体而言，通过本发明所构思的以上技术方案与现有技术相比，能够取得下列有益效果：
首先，该可驱动软体机器人主体结构为可驱动软管，其由柔性聚合物制成，具有较好的弯曲性能和可选择的管径，可以较易进入一些复杂或狭窄的空间环境中，应用场景广；
其次，可驱动软管内掺杂有磁性材料，可通过外部磁控装置灵活控制机器人各个部位的形变，具有全方位方向控制能力，可以减小在递送过程中对内部结构的损害；
再次，该可驱动软体机器人受环境影响小，性能稳定，环境温度或者轴向应变的变化对于这N根光纤的影响可看作是相同的，因此可将环境温度或者轴向应变的影响看作是共模信号，通过计算这N根微结构光纤之间的应变变化差异即可抑制环境温度或者轴向应变变化的干扰。
附图说明
图1是本申请一实施例中的可驱动软体机器人的结构示意图；
图2是本申请一实施例中的可驱动软体机器人的制备方法的步骤流程图；
图3是本申请一实施例中的可驱动软体机器人形状感知方法的步骤流程图；
图4是本申请一实施例中的通过形态感知模块确定各横截面中心点当前坐标的步骤流程图；
图5是本申请一实施例中的单模传感光纤在可驱动软管横截面上的分布示意图；
图6是本申请一实施例中的通过连接中心坐标重构可驱动软体机器人形状的示意图；
图7是本申请一实施例中的可驱动软体机器人的形状感知系统的结构框图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本申请提出一种可驱动软体机器人，图1为本申请一实施例中的可驱动软体机器人的结构示意图，如图1所示，该可驱动软体机器人包括：可驱动软管4和形态感知模块。其中，可驱动软管4是由混合有磁性材料的柔性聚合物制备而成的均匀连续结构，即可驱动软管整体均能受磁场控制。形态感知模块包括穿透可驱动软管的N根单模传感光纤N根单模传感光纤构成正N棱柱，每根单模光纤与可驱动软管的长度相同，正N棱柱的中心轴与可驱动软管的中心轴重叠，单模传感光纤用于接收光纤中光信号传播过程中的瑞利后向散射波段，N≥3。形状感知模块作为一种信号传感器件，利用传感光纤内激光在传输过程中产生的后向散射光的波长信息随可驱动软体机器人的运动而变化的原理，构建波长信息重构可驱动软体机器人形状的模型，从而计算出可驱动软体机器人任一点的位置信息。在图1中，以N＝3为例说明，形态感知模块包括第一根单模传感光纤1、第二根单模传感光纤2和第三根单模传感光纤3。
在一实施例中，单模传感光纤可以为微结构光纤。N根微结构光纤距可驱动软管中心轴的距离相等，均为r，r为大于100μm的整数。每根微结构光纤上均匀连续刻写M个光栅间隔为d2、光栅长度为d1、中心波长为λ的布拉格光纤光栅微结构单元；M为大于2的整数，d1为大于0的实数，d2为大于0的实数，λ为1260nm-1675nm宽范围波段的实数。在本实施例中，使用微结构光纤，能够极大提高信号的信噪比，减少应变测量误差，从而实现软体机器人的准确重构。
在一实施例中，制备驱动软管4的柔性聚合物可以选用PDMS(聚二甲基硅氧烷)、TPU(聚氨酯)、SEBS(氢化苯乙烯--丁二烯嵌段共聚物)、Ecoflex(脂肪族芳香族无规共聚酯)等，但不限于此，在本实施例中，选用生物相容性较好的PDMS。在一实施例中，磁性材料可以为在一定条件下能被磁化的磁性材料，例如磁性颗粒钕铁硼粉末或四氧化三铁粉末，磁性材料均匀分布于聚合物内。
在一实施例中，如图1所示，可驱动软体机器人还包括功能性外壳5，功能性外壳5包裹可驱动软管4，功能性外壳5可由不同材料配比固化而成的水凝胶材料构成，可根据实际用途选取不同特性。具体的，功能性外壳材料为AAM(丙烯酰胺)。
在一实施例中，如图1所示，可驱动机器人还包括磁控设备7，将可驱动软管置于位移水平平台6上，通过磁控设备7调控磁场，可以控制可驱动软管各部位的形变。
本申请还提出一种可驱动软体机器人的制备方法，用于制备上述可驱动软体机器人，如图2所示，该制备方法包括：
步骤S110：将磁性材料和柔性聚合物混合，形成混合材料。
在一具体的实施例中，可驱动软管原材料为磁性颗粒钕铁硼粉末(最大粒径为50um)和PDMS按照1：1比例混合形成的混合材料，并使用行星搅拌仪将其混合均匀并去除气泡，其中PDMS弹性体基质中，弹性体基础剂和固化剂的比例为10：1。
步骤S120：将混合材料倒入模具，制备可驱动软管，可驱动软管中预留有N个光纤输入孔。
以N＝3为例说明。模具由亚克力管，三根毛细支柱管，两个设计打印的三孔塞组成，并将其表面喷上PDMS脱模剂(Easy release)后放置于室温干燥，使其表面形成一层脱模涂层。用两个塞子堵住亚克力管两端，三根毛细支柱管插入塞子的孔中保持两端一一对应，将混合好的原材料注入亚克力管后再用防水胶带将所有缝隙处堵塞；将所得的模具成果放置于50℃的烘箱中固化15小时；将所获得的可驱动软管从模具中取出。
步骤S130：对可驱动软管置于磁场中进行磁化。
例如，在数字脉冲充磁机产生的3500mT强脉冲磁场下磁化。
步骤S140：将N根单模传感光纤分别嵌入对应的光纤输入孔，得到可驱动软体机器人。
其中，N根单模传感光纤构成正N棱柱，正N棱柱的中心轴与可驱动软管的中心轴重叠，单模传感光纤用于接收光纤中光信号传播过程中的瑞利后向散射波段，N≥3。
具体的，将单模传感光纤穿过可驱动软管，而后利用夹具将光纤夹直，并在通道中注入同类型的原材料，且通道两端利用硅胶胶水固定，而后将其置于50℃烘箱中固化15小时；重复上述步骤将多通道都嵌入单模传感光纤。
进一步的，在步骤S140之后，还包括：
步骤S150：形成包覆可驱动软管外表面的功能性外壳。
具体的，可利用化学接枝的方法在可驱动软管形成功能性外壳。其步骤如下：
步骤S151：将获得的可驱动软管用乙醇清洗后利用氮气干燥。
步骤S152：将干燥后的软管在等离子体清洁剂中浸泡以提高湿润度。
步骤S153：在光固化疏水引发剂溶液中浸泡15～25分钟，而后清理表面多余溶液。
步骤S154：将单体材料和光固化亲水引发剂在去离子水中利用磁子搅拌混合得到混合溶液，而后利用超声除气泡。
步骤S155：将处理过的可驱动软管放置于混合溶液中，在紫外光灯照射条件下固化55～65分钟。
步骤S156：将软管取出后在去离子水下冲洗，去除表面多余胶质。
其中，单体材料可以为丙烯酰胺、丙烯酸、N，N-二甲基丙烯酰胺、甲基丙烯酸羟乙酯、N-乙烯基吡咯烷酮中的任一种。可以理解的，包覆可驱动软管外表面的功能性外壳的材料并不限于此，可以根据具体的应用场合灵活选择适应的材料。
本申请还提出一种可驱动软体机器人的形状感知方法，如图3所示，该形状感知方法包括：
步骤S210：将可驱动软体机器人的一端作为固定端固定，另一端作为自由端送进目标对象内。
其中，可驱动软体机器人为上文介绍的可驱动软体机器人。自由端送入目标对象内的方式不做限定。
步骤S220：建立空间坐标系，记录固定端的初始坐标，利用形态感知模块重构出进入目标对象后可驱动软体机器人各横截面中心点的初始坐标。
将可驱动软体软管送入目标对象后，可驱动软管的状态记为初始状态。此时，需要识别可驱动软管的初始状态，基于初始状态进行后续的调整。具体的，确定空间坐标系的X轴、Y轴和Z轴的方向指向，将固定端的初始位置记为(0，0，0)，利用形态感知模块确定可驱动软体软管各横截面中心点的初始坐标，其中，第i横截面中心点的初始坐标记为(xi0，yi0，zi0)，将各中心点连接便能重构出可驱动软管的初始形态。
步骤S230：通过外部磁场控制可驱动软体机器人各部分扭动以使可驱动软体机器人发生形变。
当确定可驱动软管的初始形态后，需要根据目标对象内部的管道结构进一步调整可驱动软管的形态，使可驱动软管进行形变已更加适应当前环境，减小对内部结构的损伤。因此，本步骤通过启动外部磁场，并调控不同区域的磁场强度，使软管对应位置发生不同强度的扭曲，最终将可驱动软管从初始状态调整到与内部环境相适应的目标状态。在一实施例中，也可以在软管磁化期间，根据需要对软管不同位置进行不同强度的磁化，当软管进入体内后，在相同的磁场作用下，不同位置发生不同程度的形变。
步骤S240：利用形态感知模块重构出形变期间可驱动软体机器人各横截面中心点的当前坐标，获得可驱动软体机器人的当前整体形状。
在利用磁场使可驱动软管发生形变期间，可以实时监测可驱动软管的形变程度，避免软管过度形变。因此，本步骤利用形态感知模块重构出形变期间可驱动软体机器人各横截面中心点的当前坐标，将各中心点连接，便可获得可驱动软体机器人的当前整体形状。
在上述过程中，步骤S220和步骤S240均需要通过形态感知模块确定各横截面中心点的当前坐标。在一实施例中，如图4所示，通过形态感知模块确定各横截面中心点的当前坐标的步骤如下：
步骤S201：获取每根单模传感光纤的波长漂移信息。
具体的，可以通过光频域反射仪分别测得形状感知模块中的每根单模传感光纤在可驱动软体机器人形状改变前后的整条光纤上的波长漂移信息。具体的，通过利用OFDR系统获取光纤上的后向散射信号，形状改变前后的信号分别为参考信号和测量信号，对其进行瑞利散射光谱的解调，得到波长漂移信息。
步骤S202：根据波长漂移信息与可驱动软管的材料之间的应变耦合传递系统映射关系，计算在可驱动软管各横截面s上的第i根单模传感光纤的应变信息εi(s)。
其中，波长漂移信息和可驱动软管的材料之间的应变耦合传递系统的映射关系，可以提前根据实验测得。
步骤S203：获取每根单模传感光纤的分布信息，分布信息包括第i根单模传感光纤与可驱动软管中心轴之间的距离ri，以及可驱动软管横截面中第1根单模传感光纤与第i根单模传感光纤之间的夹角
如图5所示为单模传感光纤在可驱动软管横截面上的分布示意图，以N＝3为例，core1、core2、core3分别表示三根单模传感光纤的纤芯，其中，各光纤之间角度相差120°，轴向分布的三根光纤到中心的距离为ri，每根纤芯和中心的连接线与曲率方向的角度记为θi，曲率方向和中性轴正交。其中，在横截面上，第1根单模传感光纤与第i根单模传感光纤之间的夹角，指的是，第1根单模传感光纤与中心点的第1连线与第i根单模传感光纤与中心点的第i连线之间的夹角。定义其中一根光纤为第1根单模传感光纤，例如以core1、core2、core3分别为第1根、第2根和第3根单模传感光纤，第1根单模传感光纤与第1根单模传感光纤之间的夹角为第2根单模传感光纤与第1根单模传感光纤之间的夹角为/>第3根单模传感光纤与第1根单模传感光纤之间的夹角为/>
步骤S204：根据每根单模传感光纤的应变信息和每根单模传感光纤的分布信息，计算可驱动软管各横截面s的曲率k(s)和挠率τ(s)。
在一实施例中，计算曲率k(s)和挠率τ(s)的步骤如下：
构建应变信息εi(s)与曲率k(s)、挠率τ(s)的第一关系式：
其中，θ1(s)表示在横截面s上的任一根单模传感光纤与中心轴的连接线与曲率方向的夹角；
将第一关系式变形为：
简化矩阵为：
ε(s)＝Mψ(s)
其中，
令ψ1(s)＝cos(θ1(s))、ψ2(s)＝sin(θ1(s))，计算得到横截面s的曲率k(s)和挠率τ(s)：
θ1(s)＝arctan(ψ2(s)，ψ1(s))
步骤S205：根据曲率k(s)和挠率τ(s)计算出各横截面s的中心坐标γ(s)。
在一实施例中，根据曲率k(s)和挠率τ(s)计算出各横截面s的中心坐标γ(s)的步骤如下：
构建坐标γ(s)与曲率k(s)和挠率τ(s)的第二关系式：
其中，T(s)、N(s)和B(s)分别表示可驱动软管在γ(s)处的切向量、法向量和副法向量，如图6所示，每个横截面s对应一个中心坐标γ(s)，可驱动软管在每个中心坐标处均具有切向量T、法向量N、副法向量B。
将第二关系式用矩阵形式表达：
根据第二关系式计算各横截面s的中心坐标γ(s)，将各中心坐标连接，便能得到软管当前形态。
本申请还提出一种可驱动软体机器人的形状感知系统，用于感知上文的可驱动软体机器人在目标对象内部的当前整体形状，如图7所示，该形态感知系统包括：
波长漂移信息感知单元，用于获取每根单模传感光纤的波长漂移信息；
应变信息计算单元，用于根据波长漂移信息与可驱动软管的材料之间的应变耦合传递系统映射关系，计算在可驱动软管各横截面上的第i根单模传感光纤的应变信息εi(s)；
曲率和挠率计算单元，用于根据每根单模传感光纤的应变信息和每根单模传感光纤的分布信息，计算可驱动软管各横截面s的曲率k(s)和挠率τ(s)，其中，分布信息包括第i根单模传感光纤与可驱动软管中心轴之间的距离ri，以及可驱动软管横截面中第1根单模传感光纤与第i根单模传感光纤之间的夹角
形态重构单元，用于根据曲率k(s)和挠率τ(s)计算出各横截面s的中心坐标γ(s)，并基于各横截面s的中心坐标γ(s)重构可驱动软体机器人的当前整体形状。
可以理解的，该形态感知系统用于执行上文形态感知方法中的相关步骤，其各个单元的功能在于完成对应的步骤，具体可参考上文介绍，在此不再赘述。
综上，本申请中的可驱动软体机器人主体结构为可驱动软管，其由柔性聚合物制成，具有较好的弯曲性能和可选择的管径，可以较易进入一些复杂或狭窄的空间环境中，应用场景广；其次，可驱动软管内掺杂有磁性材料，可通过外部磁控装置灵活控制机器人各个部位的形变，具有全方位方向控制能力，可以减小在递送过程中对内部结构的损害；再次，该可驱动软体机器人受环境影响小，性能稳定，环境温度或者轴向应变的变化对于这N根光纤的影响可看作是相同的，因此可将环境温度或者轴向应变的影响看作是共模信号，通过计算这N根微结构光纤之间的应变变化差异即可抑制环境温度或者轴向应变变化的干扰。
本领域的技术人员容易理解，以上仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。
Claims (2)
1.一种可驱动软体机器人制备方法，其特征在于，所述可驱动软体机器人包括可驱动软管和形状感知模块，所述可驱动软管为混合有磁性材料的柔性聚合物制备而成的均匀连续结构，所述形状感知模块包括穿透所述可驱动软管的N根单模传感光纤，N根单模传感光纤构成正N棱柱，正N棱柱的中心轴与可驱动软管的中心轴重叠，所述单模传感光纤用于接收光纤中光信号传播过程中的瑞利后向散射波段；所述制备方法包括：
步骤S110：将最大粒径为50um的磁性颗粒钕铁硼粉末和聚二甲基硅氧烷混合，形成混合材料；
步骤S120：将所述混合材料倒入模具，制备可驱动软管，所述可驱动软管中预留有N个光纤输入孔；
步骤S130：对可驱动软管置于磁场中进行磁化；
步骤S140：将N根单模传感光纤分别嵌入对应的光纤输入孔，其中，N根单模传感光纤构成正N棱柱，正N棱柱的中心轴与可驱动软管的中心轴重叠，所述单模传感光纤用于接收光纤中光信号传播过程中的瑞利后向散射波段，N≥3；
步骤S150：形成包覆可驱动软管外表面的功能性外壳；
其中，步骤S150通过化学接枝的方法在可驱动软管外表面形成功能性外壳，包括：
将获得的可驱动软管用乙醇清洗后利用氮气干燥；
将干燥后的可驱动软管在等离子体清洁剂中浸泡以提高湿润度；
将浸泡后的可驱动软管在光固化疏水引发剂溶液中浸泡15～25分钟，而后清理表面多余溶液；
将单体材料和光固化亲水引发剂在去离子水中利用磁子搅拌混合得到混合溶液，而后利用超声除气泡，单体材料为丙烯酰胺、丙烯酸、N,N-二甲基丙烯酰胺、甲基丙烯酸羟乙酯、N-乙烯基吡咯烷酮中的任一种；
将在光固化疏水引发剂溶液中浸泡过的可驱动软管放置于混合溶液中，在紫外光灯照射条件下固化55～65分钟；
将可驱动软管取出后在去离子水下冲洗，去除表面多余胶质，得到可驱动软体机器人。
2.一种可驱动软体机器人的形状感知方法，其特征在于，包括：
将可驱动软体机器人的一端作为固定端固定，另一端作为自由端送进目标对象内，所述可驱动软体机器人为权利要求1所述的方法制备而成的可驱动软体机器人；
建立空间坐标系，记录固定端的初始坐标，利用形态感知模块重构出进入目标对象后可驱动软体机器人各横截面中心点的初始坐标；
通过外部磁场控制可驱动软体机器人各部分扭动以使可驱动软体机器人发生形变；
利用形态感知模块重构出形变期间可驱动软体机器人各横截面中心点的当前坐标，获得可驱动软体机器人的当前整体形状；
其中，利用形态感知模块重构出可驱动软体机器人各横截面中心点的坐标，包括
获取每根单模传感光纤的波长漂移信息；
根据波长漂移信息与可驱动软管的材料之间的应变耦合传递系统映射关系，计算在可驱动软管各横截面s上的第i根单模传感光纤的应变信息εi(s)；
获取每根单模传感光纤的分布信息，所述分布信息包括第i根单模传感光纤与可驱动软管中心轴之间的距离ri，以及可驱动软管横截面中第1根单模传感光纤与第i根单模传感光纤之间的夹角
根据每根单模传感光纤的应变信息和每根单模传感光纤的分布信息，计算可驱动软管各横截面s的曲率k(s)和挠率τ(s)；
根据曲率k(s)和挠率τ(s)计算出各横截面s的中心坐标γ(s)；
其中，计算可驱动软管各横截面s的曲率k(s)和挠率τ(s)，包括：
构建应变信息εi(s)与曲率k(s)、挠率τ(s)的第一关系式： 其中，θ1(s)表示在横截面s上的任一根单模传感光纤与中心轴的连接线与曲率方向的夹角；
将第一关系式变形为记为矩阵ε(s)＝Mψ(s)；
计算横截面s的曲率k(s)和挠率τ(s)，其中， θ1(s)＝arctan(ψ2(s),ψ1(s))，ψ1(s)＝cos(θ1(s))，ψ2(s)＝sin(θ1(s))；
其中，根据曲率k(s)和挠率τ(s)计算出各横截面s的中心坐标γ(s)，包括：
构建坐标γ(s)与曲率k(s)和挠率τ(s)的第二关系式：
其中，T(s)、N(s)和B(s)分别表示可驱动软管在γ(s)处的切向量、法向量和副法向量；
根据所述第二关系式计算各横截面s的中心坐标γ(s)。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111648202.3A CN114131580B (zh) | 2021-12-30 | 2021-12-30 | 可驱动软体机器人及其制备方法、形状感知方法及系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111648202.3A CN114131580B (zh) | 2021-12-30 | 2021-12-30 | 可驱动软体机器人及其制备方法、形状感知方法及系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114131580A CN114131580A (zh) | 2022-03-04 |
| CN114131580B true CN114131580B (zh) | 2024-02-02 |
Family
ID=80383733
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111648202.3A Active CN114131580B (zh) | 2021-12-30 | 2021-12-30 | 可驱动软体机器人及其制备方法、形状感知方法及系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114131580B (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114931437B (zh) * | 2022-07-25 | 2022-10-18 | 中国科学院自动化研究所 | 感测型连续体机器人、介入感测系统及方法 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2015044832A1 (en) * | 2013-09-30 | 2015-04-02 | Koninklijke Philips N.V. | Multipurpose lumen design for optical shape sensing |
| CN104783798A (zh) * | 2015-04-13 | 2015-07-22 | 上海交通大学 | 用于感知医用软体机械臂形状的系统及方法 |
| CN112659106A (zh) * | 2020-12-31 | 2021-04-16 | 华中科技大学 | 一种磁性软体机器人的驱动方法及系统 |
| CN112826424A (zh) * | 2021-02-25 | 2021-05-25 | 嘉兴学院 | 一种具有姿态感应功能的医用内窥镜结构及其使用方法 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US11129679B2 (en) * | 2017-11-14 | 2021-09-28 | Mako Surgical Corp. | Fiber optic tracking system |
-
2021
- 2021-12-30 CN CN202111648202.3A patent/CN114131580B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2015044832A1 (en) * | 2013-09-30 | 2015-04-02 | Koninklijke Philips N.V. | Multipurpose lumen design for optical shape sensing |
| CN105636503A (zh) * | 2013-09-30 | 2016-06-01 | 皇家飞利浦有限公司 | 用于光学形状感测的多用途内腔设计 |
| CN104783798A (zh) * | 2015-04-13 | 2015-07-22 | 上海交通大学 | 用于感知医用软体机械臂形状的系统及方法 |
| CN112659106A (zh) * | 2020-12-31 | 2021-04-16 | 华中科技大学 | 一种磁性软体机器人的驱动方法及系统 |
| CN112826424A (zh) * | 2021-02-25 | 2021-05-25 | 嘉兴学院 | 一种具有姿态感应功能的医用内窥镜结构及其使用方法 |
Non-Patent Citations (1)
| Title |
|---|
| Multi-Core Optical Fibers With Bragg Gratings as Shape Sensor for Flexible Medical Instruments;Fouzia Khan;IEEE SENSORS JOURNAL;第19卷(第14期);5878-5884 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114131580A (zh) | 2022-03-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN114131580B (zh) | 可驱动软体机器人及其制备方法、形状感知方法及系统 | |
| Hu et al. | Adhesive tough magnetic hydrogels with high Fe3O4 content | |
| KR100713726B1 (ko) | 입체 모델 | |
| CN101152646B (zh) | 柔性超声换能器阵列及其应用装置 | |
| US20090015818A1 (en) | Catheter Surgery Simulation | |
| CN108784837A (zh) | 软体机器人及其制造方法和控制系统 | |
| CN114209891B (zh) | 一种湿态粘附的超润滑水凝胶涂层及其制备方法 | |
| CN1692871A (zh) | 软性内窥镜三维曲线形状检测装置和方法 | |
| Peters et al. | Superparamagnetic swimming microrobots with adjusted magnetic anisotropy | |
| CN109045367A (zh) | 一种医用导管导丝表面的亲水涂层的制备方法及其产品 | |
| US11779422B2 (en) | Magnetically steerable continuum robotic guidewires for neurovascular applications | |
| CN110843163B (zh) | 一种软材料中复杂磁畴编程的快速实现方法 | |
| US6396198B1 (en) | Wave transmission-reception element for use in ultrasound probe, method for manufacturing the wave transmission-reception element and ultrasound probe incorporating the transmission-reception element | |
| CN112029035B (zh) | 基于数字光处理3d打印的柔性传感器的制造方法 | |
| EP1886618A1 (en) | Capsule endoscope | |
| Dos Santos et al. | Bond strength of self-adhesive resin cements to composite submitted to different surface pretreatments | |
| CN103623493A (zh) | 一种超声显影导管及成型工艺 | |
| CN113042732B (zh) | 可植入生物体的3d打印磁控变形夹持装置及方法 | |
| Franco et al. | Adaptive control of a master-slave system for teleoperated needle insertion under MRI-guidance | |
| CN110680322A (zh) | 一种描述磁共振成像信号非指数衰减的方法及其应用 | |
| JP2012524887A (ja) | 光学歪み測定装置 | |
| CN108680190A (zh) | 利用溶菌酶焊接的自支撑银薄膜制备的柔性电子传感器及制备方法 | |
| CN111616773A (zh) | 一种治疗泌尿和消化系统结石的取石装置及其使用方法 | |
| CN203598334U (zh) | 一种超声显影导管 | |
| CN111718545A (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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |