一种核聚变舱中仿蠕虫机器人行走机构的控制方法技术

本发明专利技术公开了一种核聚变舱中仿蠕虫机器人行走机构的控制方法，其特征是由前体节侧向定位模块与后体节侧向定位模块在中体节轴向运动模块的两端对称设置构成行走机构；行走机构设定的步骤完成一个前进步距或一个后退步距的行走过程。本发明专利技术运动轨迹可以遍及整个核聚变舱底部的大双环形槽道，运动步态类似蠕虫行走，运行稳定性好且控制简单，通过搭载视觉观测云台可以实现对核聚变舱内部空间三个自由度的全方位视觉信息采集。

【技术实现步骤摘要】
一种核聚变舱中仿蠕虫机器人行走机构的控制方法本申请是申请号为：2015101006809、申请日为：2015年3月6日、专利技术名称为：运行在核聚变舱中的仿蠕虫机器人行走机构及控制方法的分案申请。
本专利技术属于核环境遥操纵机器人及自动化
，更具体地说是涉及一种运行在核聚变舱中的仿蠕虫机器人行走机构及控制方法。
技术介绍
托卡马克是一种利用磁约束来实现受控核聚变的环形容器，其中央是一个外面缠绕着线圈的环形真空室；在通电的时候托卡马克的内部会产生巨大的螺旋型磁场，将其中的等离子体加热到很高的温度，以达到核聚变的目的。全托卡马克装置的内部舱体一般被称为核聚变反应舱，作为当代核能源产生和制备的核心载体，其内部环境属于一种典型极端环境，一方面具有强辐射、高温、强磁场以及高真空等物理特点，另一方面，反应舱内部设备众多，管道错综复杂，通道狭隘，工作空间小，再加上舱内的某些部件会受到放射性和有毒物质的污染，即使在设备的维护保养期间维护人员也不能或不宜直接对反应舱内部相关部件进行操作，因此需要借助于舱外遥操纵手段，通过一种智能型机电设备替代人类进入舱内完成相应的作业任务。为了应对反应舱内部的恶劣环境，保证核聚变反应堆的正常工作秩序，需要研制一种面向核聚变反应舱环境的行走机构，用来执行反应舱内部件的日常观测、侦察和巡检等对各种状态信息的采集、处理、表示和识别等任务，监视核聚变反应堆的具体工作情况，以便为异常情况出现时采取相应的决策提供依据。目前国内外对于核聚变舱遥操纵机器人行走机构的公开报道为数不多。荷兰爱思唯尔(Elsevier)科学出版公司出版的《聚变工程与设计》(FusionEngineeringandDesign，83(2008)，pp:1833–1836.)中公开了一种ArticulatedInspectionArm(AIA)机器人，属于一种针对核聚变舱环境的悬空式机器人行走机构，采用5个关节的模块化设计，每个关节处分别有一个俯仰自由度和一个偏转自由度，偏转运动由安装在模块内的驱动电机提供，俯仰运动由平行四边形杆内的螺旋千斤顶处的电机提供，各电机输出轴的运动通过钢索传递至大角度回转关节索轮处，带动机器人各模段之间产生相对回转运动，该机器人可在核聚变舱物理实验的间歇期内进入舱内移动，对真空室第一壁进行近距离观测，监测全托卡马克装置在运行期间真空室内的工作情况；但由于该机器人属于悬臂式结构，一方面其动力驱动装置分别集成在各机械臂关节内部，增加了机器人关节臂的重量，加大了机器人末端支撑装置的承载负担，使得机器人总体尺寸不宜过长，从而限制了机器人在核聚变舱内的探测活动空间范围；另一方面由于该机器人各关节行走机构的回转运动需要各自驱动装置同步协调控制，步态轨迹较难精准规划,且受机械臂自重的干扰，机器人前端探测装置在运行过程中容易出现抖动现象，影响了系统的定位精度和运动稳定性。中国专利申请CN102233575A公开的一种用于核辐射环境下的小型应急救援及探测机器人，其行走机构采用履带式底盘结构，驱动电机放置在底盘中部，通过链条驱动履带运行，底盘前端设有四自由度机械手，伽马相机及成像系统位于机器人后部，可以对核环境下的辐射强度和方位进行探测，并通过机器人机械臂进行应急处理；该机器人的行走机构虽然具备一定的通过能力，可用于核聚变舱外围的一些非结构化环境，但仍然无法在几何构造条件苛刻的核聚变舱内部空间运行，限制了其使用范围。
技术实现思路
本专利技术是为避免上述现有技术所存在的不足之处，提供一种核聚变舱中仿蠕虫机器人行走机构的控制方法，以克服现有技术中悬臂式方案所造成的对核聚变舱内部空间探测范围及定位精度有限并且运行不稳定等缺陷，使其运动轨迹可遍及整个核聚变舱底部的大双环形槽道，运动步态类似蠕虫行走，运行稳定性好且控制简单，通过搭载视觉观测云台实现对核聚变舱内部空间三个自由度的全方位视觉信息采集，以期降低机器人行走机构本体对承载能力的要求，改善核环境遥操纵机器人平台对核聚变舱内部结构化特定环境的运动适应性。本专利技术为解决技术问题采用如下技术方案：本专利技术运行在核聚变舱中的仿蠕虫机器人行走机构的结构特点是：由前体节侧向定位模块与后体节侧向定位模块在中体节轴向运动模块的两端对称设置构成；所述前体节侧向定位模块的结构设置为：电驱动子模块固装于承载子模块的内部，并有具有相同的结构形式的内侧对开支撑子模块和外侧对开支撑子模块对称设置于所述电驱动子模块的左右两侧；所述内侧对开支撑子模块和外侧对开支撑子模块的一端分别固联于电驱动子模块的左右两侧设定位置处，另一端分别沿所述电驱动子模块的左右侧向可伸缩运动并以所述承载子模块为导轨；在所述前体节侧向定位模块的顶部，位于中央设置前体节热控装置，位于侧部设置前体节配重系统，所述前体节配重系统处在前体节侧向定位模块中外侧对开支撑子模块的上方；所述后体节侧向定位模块与所述前体节侧向定位模块具有相同的结构形式；在所述后体节侧向定位模块的顶部，位于中央设置后体节热控装置，位于侧部设置后体节配重系统，所述后体节配重系统处在所述后体节侧向定位模块中外侧对开支撑子模块的上方；所述中体节轴向运动模块的结构设置为：前节段子模块固装于壳体子模块的内部；所述前节段子模块和后节段子模块在壳体子模块的内部相联并且相互间沿前后方向可相对运动，形成可伸缩的中体节轴向运动模块，所述后节段子模块突出于所述中体节轴向运动模块的尾部端面；在所述中体节轴向运动模块的顶部，位于中央设置中体节热控装置；在所述前体节侧向定位模块与中体节轴向运动模块之间以前双万向节相联接，在所述后体节侧向定位模块与中体节轴向运动模块之间以后双万向节相联接。本专利技术运行在核聚变舱中的仿蠕虫机器人行走机构的结构特点也在于：所述前体节侧向定位模块中承载子模块的结构设置为：以第一矩形底板为底面，以第一矩形顶板为顶面，在所述第一矩形底板和第一矩形顶板之间以前侧板为前端面、以后侧板为后端面，以内斜板为左端面，以外斜板为右端面形成前体节矩形框架；在所述前体节矩形框架的外部，位于所述内斜板上设置有内滚球支承装置，位于所述外斜板上设置有外滚球支承装置，以所述内滚球支承装置和外滚球支承装置作为所述前体节矩形框架在左端面和右端面上的支撑件；在所述前体节矩形框架的外部，位于所述第一矩形底板上设置有万向脚轮，以所述万向脚轮作为所述前体节矩形框架在底面的支撑件；所述内滚球支承装置是以核聚变舱中大双环形槽道的内环壁为支撑面；所述外滚球支承装置是以所述核聚变舱中大双环形槽道的外环壁为支撑面；所述前体节侧向定位模块中电驱动子模块的结构设置为：在所述前体节矩形框架的内部，位于所述第一矩形底板上并处在同轴线的位置上依次设置对开支撑子模块固定支座、第一电机支座、第一轴承支座和第二轴承支座；在所述第一电机支座上固定安装第一真空伺服减速电机，所述第一真空伺服减速电机的输出轴通过第一联轴器与第一中心滚珠丝杆相联接；所述第一中心滚珠丝杆为阶梯轴，所述阶梯轴的两端分别通过第一双列角接触球轴承和第一深沟球轴承支承于所述第一轴承支座和第二轴承支座之间，第一螺套以滚动螺旋配合套装在所述第一中心滚珠丝杆的螺纹轴段上；第一移动平板固装于所述第一螺套上；设置第一移动平板导向结构，是在所述第一中心滚珠丝杆的两侧平行设置第一导向本文档来自技高网...

【技术保护点】
一种核聚变舱中仿蠕虫机器人行走机构的控制方法，其特征是：所述仿蠕虫机器人行走机构是由前体节侧向定位模块(1)与后体节侧向定位模块(3)在中体节轴向运动模块(2)的两端对称设置构成；所述前体节侧向定位模块(1)的结构设置为：电驱动子模块(1B)固装于承载子模块(1A)的内部，并有具有相同的结构形式的内侧对开支撑子模块(1C)和外侧对开支撑子模块(1D)对称设置于所述电驱动子模块(1B)的左右两侧；所述内侧对开支撑子模块(1C)和外侧对开支撑子模块(1D)的一端分别固联于电驱动子模块(1B)的左右两侧设定位置处，另一端分别沿所述电驱动子模块(1B)的左右侧向可伸缩运动并以所述承载子模块(1A)为导轨；在所述前体节侧向定位模块(1)的顶部，位于中央设置前体节热控装置(9)，位于侧部设置前体节配重系统(7)，所述前体节配重系统(7)处在前体节侧向定位模块(1)中外侧对开支撑子模块的上方；所述后体节侧向定位模块(3)与所述前体节侧向定位模块(1)具有相同的结构形式；在所述后体节侧向定位模块(3)的顶部，位于中央设置后体节热控装置(11)，位于侧部设置后体节配重系统(8)，所述后体节配重系统(8)处在所述后体节侧向定位模块(3)中外侧对开支撑子模块的上方；所述中体节轴向运动模块(2)的结构设置为：前节段子模块(2B)固装于壳体子模块(2A)的内部；所述前节段子模块(2B)和后节段子模块(2C)在壳体子模块(2A)的内部相联并且相互间沿前后方向可相对运动，形成可伸缩的中体节轴向运动模块(2)，所述后节段子模块(2C)突出于所述中体节轴向运动模块(2)的尾部端面；在所述中体节轴向运动模块(2)的顶部，位于中央设置中体节热控装置(10)；在所述前体节侧向定位模块(1)与中体节轴向运动模块(2)之间以前双万向节(4)相联接，在所述后体节侧向定位模块(3)与中体节轴向运动模块(2)之间以后双万向节(5)相联接；所述仿蠕虫机器人行走机构的控制方法设置为：所述行走机构按如下步骤完成一个前进步距的行走过程：步骤1：前体节侧向定位模块(1)和后体节侧向定位模块(3)均处于锁止状态，中体节轴向运动模块(2)处于最小缩短状态；行走机构定位在位置A处；步骤2：前体节侧向定位模块(1)设置为解锁状态，后体节侧向定位模块(3)保持在锁止状态，中体节轴向运动模块(2)伸长直至达到最大伸长状态，行走机构处在由位置A向位置B的行进中；步骤3：前体节侧向定位模块(1)设置为锁止状态，后体节侧向定位模块(3)设置为解锁状态，中体节轴向运动模块(2)缩短直至达到最小缩短状态，行走机构行进到位置B处；步骤4：前体节侧向定位模块(1)保持在锁止状态，后体节侧向定位模块(3)进入锁止状态，中体节轴向运动模块(2)保持在最小缩短状态，行走机构定位在位置B处；所述行走机构按如下步骤完成一个后退步距的行走过程：步骤1：前体节侧向定位模块(1)和后体节侧向定位模块(3)均处于锁止状态，中体节轴向运动模块(2)处于最小缩短状态；行走机构定位在位置A处；步骤2：前体节侧向定位模块(1)保持为锁止状态，后体节侧向定位模块(3)设置为解锁状态，中体节轴向运动模块(2)伸长直至达到最大伸长状态，行走机构处在由位置A向位置C的行进中；步骤3：前体节侧向定位模块(1)设置为解锁状态，后体节侧向定位模块(3)设置为锁止状态，中体节轴向运动模块(2)缩短直至达到最小缩短状态，行走机构行进到位置C处；步骤4：前体节侧向定位模块(1)设置为在锁止状态，后体节侧向定位模块(3)保持在锁止状态，中体节轴向运动模块(2)保持在最小缩短状态，行走机构定位在位置C处。...

【技术特征摘要】
1.一种核聚变舱中仿蠕虫机器人行走机构的控制方法，其特征是：所述仿蠕虫机器人行走机构是由前体节侧向定位模块(1)与后体节侧向定位模块(3)在中体节轴向运动模块(2)的两端对称设置构成；所述前体节侧向定位模块(1)的结构设置为：电驱动子模块(1B)固装于承载子模块(1A)的内部，并有具有相同的结构形式的内侧对开支撑子模块(1C)和外侧对开支撑子模块(1D)对称设置于所述电驱动子模块(1B)的左右两侧；所述内侧对开支撑子模块(1C)和外侧对开支撑子模块(1D)的一端分别固联于电驱动子模块(1B)的左右两侧设定位置处，另一端分别沿所述电驱动子模块(1B)的左右侧向可伸缩运动并以所述承载子模块(1A)为导轨；在所述前体节侧向定位模块(1)的顶部，位于中央设置前体节热控装置(9)，位于侧部设置前体节配重系统(7)，所述前体节配重系统(7)处在前体节侧向定位模块(1)中外侧对开支撑子模块的上方；所述后体节侧向定位模块(3)与所述前体节侧向定位模块(1)具有相同的结构形式；在所述后体节侧向定位模块(3)的顶部，位于中央设置后体节热控装置(11)，位于侧部设置后体节配重系统(8)，所述后体节配重系统(8)处在所述后体节侧向定位模块(3)中外侧对开支撑子模块的上方；所述中体节轴向运动模块(2)的结构设置为：前节段子模块(2B)固装于壳体子模块(2A)的内部；所述前节段子模块(2B)和后节段子模块(2C)在壳体子模块(2A)的内部相联并且相互间沿前后方向可相对运动，形成可伸缩的中体节轴向运动模块(2)，所述后节段子模块(2C)突出于所述中体节轴向运动模块(2)的尾部端面；在所述中体节轴向运动模块(2)的顶部，位于中央设置中体节热控装置(10)；在所述前体节侧向定位模块(1)与中体节轴向运动模块(2)之间以前双万向节(4)相联接，在所述后体节侧向定位模块(3)与中体节轴向运动模块(2)之间以后双万向节(5)相联接；所述仿蠕虫机器人行走机构的控制方法设置为：所述行走机构按如下步骤完成一个前进步距的行走过程：步骤1：前体节侧向定位模块(1)和后体节侧向定位模块(3)均处于锁止状态，中体节轴向运动模块(2)处于最小缩短状态；行走机构定位在位置A处；步骤2：前体节侧向定位模块(1)设置为解锁状态，后体节侧向定位模块(3)保持在锁止状态，中体节轴向运动模块(2)伸长直至达到最大伸长状态，行走机构处在由位置A向位置B的行进中；步骤3：前体节侧向定位模块(1)设置为锁止状态，后体节侧向定位模块(3)设置为解锁状态，中体节轴向运动模块(2)缩短直至达到最小缩短状态，行走机构行进到位置B处；步骤4：前体节侧向定位模块(1)保持在锁止状态，后体节侧向定位模块(3)进入锁止状态，中体节轴向运动模块(2)保持在最小缩短状态，行走机构定位在位置B处；所述行走机构按如下步骤完成一个后退步距的行走过程：步骤1：前体节侧向定位模块(1)和后体节侧向定位模块(3)均处于锁止状态，中体节轴向运动模块(2)处于最小缩短状态；行走机构定位在位置A处；步骤2：前体节侧向定位模块(1)保持为锁止状态，后体节侧向定位模块(3)设置为解锁状态，中体节轴向运动模块(2)伸长直至达到最大伸长状态，行走机构处在由位置A向位置C的行进中；步骤3：前体节侧向定位模块(1)设置为解锁状态，后体节侧向定位模块(3)设置为锁止状态，中体节轴向运动模块(2)缩短直至达到最小缩短状态，行走机构行进到位置C处；步骤4：前体节侧向定位模块(1)设置为在锁止状态，后体节侧向定位模块(3)保持在锁止状态，中体节轴向运动模块(2)保持在最小缩短状态，行走机构定位在位置C处。2.根据权利要求1所述的核聚变舱中仿蠕虫机器人行走机构的控制方法，其特征是：所述前体节侧向定位模块(1)中承载子模块(1A)的结构设置为：以第一矩形底板(101)为底面，以第一矩形顶板(107)为顶面，在所述第一矩形底板(101)和第一矩形顶板(107)之间以前侧板(106)为前端面、以后侧板(102)为后端面，以内斜板(104M)为左端面，以外斜板(104N)为右端面形成前体节矩形框架；在所述前体节矩形框架的外部，位于所述内斜板(104M)上设置有内滚球支承装置(105M)，位于所述外斜板(104N)上设置有外滚球支承装置(105N)，以所述内滚球支承装置(105M)和外滚球支承装置(105N)作为所述前体节矩形框架在左端面和右端面上的支撑件；在所述前体节矩形框架的外部，位于所述第一矩形底板(101)上设置有万向脚轮(103)，以所述万向脚轮(103)作为所述前体节矩形框架在底面的支撑件；所述内滚球支承装置(105M)是以核聚变舱(12)中大双环形槽道的内环壁(12M)为支撑面；所述外滚球支承装置(105N)是以所述核聚变舱(12)中大双环形槽道的外环壁(12N)为支撑面；所述前体节侧向定位模块(1)中电驱动子模块(1B)的结构设置为：在所述前体节矩形框架的内部，位于所述第一矩形底板(101)上并处在同轴线的位置上依次设置对开支撑子模块固定支座(108)、第一电机支座(109)、第一轴承支座(110)和第二轴承支座(113)；在所述第一电机支座(109)上固定安装第一真空伺服减速电机(122)，所述第一真空伺服减速电机(122)的输出轴通过第一联轴器(121)与第一中心滚珠丝杆(114)相联接；所述第一中心滚珠丝杆(114)为阶梯轴，所述阶梯轴的两端分别通过第一双列角接触球轴承(124)和第一深沟球轴承(115)支承于所述第一轴承支座(110)和第二轴承支座(113)之间，第一螺套(111)以滚动螺旋配合套装在所述第一中心滚珠丝杆(114)的螺纹轴段上；第一移动平板(112)固装于所述第一螺套(111)上；设置第一移动平板(112)导向结构，是在所述第一中心滚珠丝杆(114)的两侧平行设置第一导向杆(118)，所述第一导向杆(118)的一端固装于第一轴承支座(110)上，另一端通过第一套筒(117)固装于第二轴承支座(113)上，所述第一移动平板(112)利用第一直线轴承(119)支承在所述第一导向杆(118)上，使所述第一移动平板(112)在所述第一螺套(111)的带动下可以在第一导向杆(118)上轴向移动；在所述第一矩形底板(101)上、位于所述第一中心滚珠丝杆(114)的正下方设置有第一光电开关(126)，所述第一光电开关(126)位于第一轴承支座(110)和第二轴承支座(113)之间设定位置处；所述前体节侧向定位模块(1)中外侧对开支撑子模块(1D)和内侧对开支撑子模块(1C)具有如下相同的结构形式：在所述对开支撑子模块固定支座(108)和第一移动平板(112)的旁侧设置大平板(140)，在所述大平板(140)的内侧与对开支撑子模块固定支座(108)的相对位置处固定安装联接板(132)，在所述大平板(140)的内侧与第一移动平板(112)的相对位置处固定安装滑轨(141)，所述滑轨(141)与第一中心滚珠丝杆(114)的轴线平行，在所述滑轨(141)上滑动配合有滑块(142)；平行设置的第一上连杆(144)和第一下连杆(146)在一端通过第一上铰支座(129)、第一下铰支座(127)以及第一销轴(128)与对开支撑子模块固定支座(108)相铰接；在另一端通过双铰支座(143)和第四销轴(145)与所述滑块(142)相铰接；平行设置的第二上连杆(139)和第二下连杆(150)在一端通过第三上铰支座(135)、第三下铰支座(130)以及第三销轴(131)与安装联接板(132)相铰接，在另一端通过第二上铰支座(147)、第二下铰支座(149)以及第二销轴(148)与第一移动平板(112)相铰接；在所述内侧对开支撑子模块(1C)中，在其大平板的外侧固定设置内楔形支架(133M)，在所述内楔形支架(133M)的外端面上设置有内万向撑爪(134M)；在所述外侧对开支撑子模块(1D)中，在其大平板的外侧固定设置外楔形支架(133N)，在所述外楔形支架(133N)的外端面上设置外...

【专利技术属性】
技术研发人员：张强，刘宜，汪增福，高理富，孔德义，
申请(专利权)人：中国科学院合肥物质科学研究院，
类型：发明
国别省市：安徽;34