[发明专利]核退役机器人末端工具远程换装方法

权利要求书

1.核退役机器人末端工具远程换装方法，其特征是，基于核退役机器人末端工具远程换装系统；

所述的核退役机器人末端工具远程换装系统，包括计算机、核退役机器人、遥控器、传感器组件、数据传输组件、快换装置及末端工具；

计算机包括图像处理模块、位姿计算模块、显示器、数据收发模块A及三维动画模块；

核退役机器人包括机身及安装在机身上的多节段机械臂，多节段机械臂包含多节依次铰接相连的手臂和用于驱动每一节手臂绕其铰接处转动的液压缸；

遥控器与核退役机器人以通信方式连接，以控制核退役机器人动作；

传感器组件包括单目摄像头、数据采集卡、直线位移传感器；单目摄像头固定安装在核退役机器人的机身上，并具有核退役机器人的多节段机械臂活动范围内的视野；多个直线位移传感器分别安装在多节段机械臂的每一个液压缸上，以实时检测液压缸活塞杆的伸缩长度，直线位移传感器与数据采集卡以通信方式连接

数据传输组件包括数据收发模块B；数据收发模块B与单目摄像头以通信方式连接，数据收发模块B与计算机的数据收发模块A以通信方式连接；

快换装置包括第一装配体和第二装配体；第二装配体安装在多节段机械臂的末端，第一装配体与第二装配体可拆卸的连接；第一装配体包括工具盘、公接头座及公接头；工具盘外侧表面设有工具安装面，内侧表面从上至下依次设有勾接部A和锁定臂；公接头座固定安装在工具盘的内侧表面上，公接头安装在公接头座上；第二装配体包括基座、母接头座、母接头及对接锁定组件；基座两端分别设有与多节段机械臂的末端相连接的第一连接段和与工具盘相连接的第二连接段，第二连接段的上端设有与勾接部A相配合的勾接部B，下端设有用于抵住锁定臂的定位缺口，第二连接段内设有元件安装腔，第二连接段的下端两侧设有连通至元件安装腔的锁定销孔；母接头安装在母接头座上，母接头座安装在对接锁定组件上；对接锁定组件设在基座上，对接锁定组件包括同步液压缸和锁定销；两个同步液压缸对称安设置在元件容纳腔的两侧，两个同步液压缸的活塞分别固接在元件容纳腔的上端两侧，两根锁定销分别固接在两个同步液压缸的缸体上，同步液压缸的活塞杆伸缩时带动同步液压缸的缸体在元件容纳腔中做往复直线运动，进而带动锁定销从锁定销孔中伸出或缩回；当第一装配体与第二装配体连接时，第二装配体通过勾接部B与第一装配体的勾接部A相互勾接，工具盘上的锁定臂与基座上的定位缺口相抵，对接锁定组件用于锁定锁定臂的同时带动母接头与公接头对接，或解锁锁定臂的同时带动母接头与公接头分离；在第一装配体与第二装配体连接的状态下，当锁定销伸出锁定销孔时，一方面将锁定臂锁定在锁定销与定位缺口之间，另一方面带动母接头与公接头对接，当锁定销缩回锁定销孔时，一方面将锁定臂解锁，另一方面带动母接头与公接头分离；勾接部B为对称设置在基座第二连接段上端两侧的勾爪；勾接部A为对称设置设在工具盘内侧表面上端两侧的定位短轴，定位短轴的形状与勾爪相适应，定位短轴的外露长度与勾爪的宽度相适应；

末端工具固定连接在第一装配体的工具盘的工具安装面上；

步骤如下：

S01，初始准备工作：

a、在多个第一装配体上分别粘贴标识码A，再将不同的末端工具分别连接在粘贴有标识码A的第一装配体上；

b、在核退役机器人的工作区域附近设置换装区域，在换装区域的边缘处设置墙体，沿着墙体在换装区域内划分出多个并列排布的子区域，再在墙体上分别粘贴与每个子区域位置对应的标识码B；

c、将多个连接有末端工具的第一装配体分别放置在换装区域的各个子区域内，并使所有末端工具朝向墙体；

本步骤中，每个子区域内仅可放置一个连接有末端工具的第一装配体；

S02，获取核退役机器人与卸载用的子区域之间的实时位置关系：

a、操控核退役机器人机身上的单目摄像头扫过不同的标识码B，计算机的图像处理模块实时提取并识别单目摄像头拍摄画面中的标识码B，并通过显示器实时显示当前拍摄画面中的标识码B所对应的子区域，以供操作者决策；

b、当操作者确认搜寻到卸载用的子区域时，位姿计算模块随即开始计算单目摄像头与目标子区域对应的标识码B的实时相对位置，并通过显示器实时显示；

本步骤中，标识码B与对应子区域的位置关系不会发生变化，据此，事先测量标识码B与对应子区域的相对位置，再结合单目摄像头与目标子区域对应的标识码B的实时相对位置即可计算出单目摄像头与目标子区域的实时相对位置；

S03，移动到卸载用的子区域并卸下当前末端工具：

a、控制核退役机器人向着目标子区域对应的最佳卸载区域移动；此过程中，操作者基于单目摄像头与目标子区域的实时相对位置，以及目标子区域与其对应的最佳卸载区域的相对位置，即可实现核退役机器人的移动导向；

b、当核退役机器人移动进入目标子区域对应的最佳卸载区域时，操作者控制多节段机械臂下放，使连接有末端工具的第一装配体在目标子区域内接地；此过程中，操作者基于多节段机械臂与目标子区域的实时相对位置即可实现多节段机械臂的准确控制；

c、控制第一装配体与第二装配体分离，将连接有末端工具的第一装配体卸载在目标子区域内；此过程中，第一装配体与第二装配体的分离过程如下：1，控制两个同步液压缸的活塞杆同步伸出，带动锁定销从锁定销孔中缩回，一方面将锁定臂解锁，另一方面带动母接头脱离公接头，从而解除第一装配体与第二装配体的锁定关系；2，操纵多节段机械臂动作，使第二装配体绕定位短轴转动，直至公、母接头之间达到安全距离时停止，然后操纵多节段机械臂，使基座的勾爪脱离工具盘的定位短轴，即将第一装配体与第二装配体分离；

本步骤中，液压缸的活塞杆伸缩带动多节段机械臂中对应的手臂转动，液压缸的活塞杆的伸缩量与多节段机械臂中对应的手臂的转动角度的关系是确定的，通过直线位移传感器测量各个液压缸的活塞杆的伸缩量，位姿计算模块即可计算出多节段机械臂中的各节手臂的运动状态，进而合成多节段机械臂的整体运动状态；位姿计算模块再结合单目摄像头与目标子区域的实时相对位置，以及单目摄像头与多节段机械臂的相对位置，即可计算出多节段机械臂与目标子区域的实时相对位置；

本步骤中，每个子区域分别具有对应的最佳卸载区域，当核退役机器人进入最佳卸载区域时，仅操作多节段机械臂即可将连接有末端工具的第一装配体卸载在对应的子区域内，那么，子区域与其对应的最佳卸载区域的相对位置是固定的，事先测定待用；

S04，获取核退役机器人与对接用的子区域之间的实时位置关系：

a、操作者控制多节段机械臂抬起一定高度，防止在后续的移动过程中碰撞或剐蹭地面；

b、操控核退役机器人机身上的单目摄像头扫过不同的标识码B，计算机的图像处理模块实时提取并识别单目摄像头拍摄画面中的标识码B，并通过显示器实时显示当前拍摄画面中的标识码B所对应的子区域，以供操作者决策；

c、当操作者确认搜寻到对接用的子区域时，位姿计算模块随即开始计算单目摄像头与目标子区域对应的标识码B的实时相对位置，并通过显示器实时显示，操作者据此控制核退役机器人向目标子区域移动；

S05，移动到对接用的子区域并装载所需末端工具：

a、控制核退役机器人向着目标子区域移动，核退役机器人上搭载的单目摄像头与目标标识码A的距离越来越近，当单目摄像头识别到目标标识码A时，位姿计算模块同时进行以下两项操作：1、计算单目摄像头与目标标识码A的实时相对位置；2、标定目标标识码A对应的最佳对接区域的位置；

b、控制核退役机器人向着目标标识码A对应的最佳对接区域移动；此过程中，操作者基于单目摄像头与目标标识码A的实时相对位置，以及目标标识码A与其对应的最佳对接区域的相对位置，即可实现核退役机器人的移动导向；

c、当核退役机器人到达目标标识码A对应的最佳对接区域时，计算机的三维动画模块基于其内置的连接有第二装配体的多节段机械臂三维模型和连接有末端工具的第一装配体三维模型，结合多节段机械臂与第一装配体的实时相对位置，生成对接过程的实时三维动画；

d、操作者在实时三维动画的辅助下，控制多节段机械臂动作，使连接在多节段机械臂末端的第二装配体与连接有末端工具的第一装配体进行对接；此过程中，第二装配体与第一装配体的对接过程如下：1、调整多节段机械臂的位姿，使基座的勾爪勾住工具盘上的定位短轴，然后操纵多节段机械臂，使第二装配体绕定位短轴转动，直至基座的定位缺口抵住工具盘的锁定臂；2、两个同步液压缸的活塞杆同步伸出，带动锁定销从锁定销孔中伸出，一方面将锁定臂锁定在锁定销与定位缺口之间，另一方面带动母接头与公接头对接，即完成第二装配体与第一装配体的对接；

本步骤中，目标标识码A为目标子区域内放置的第一装配体上的标识码A；

本步骤中，目标子区域内放置有粘贴了标识码A的第一装配体，所述第一装配体上连接有所需末端工具；

本步骤中，每个第一装配体分别具有对应的最佳对接区域，当核退役机器人进入最佳对接区域时，仅操作多节段机械臂即可实现第二装配体与第一装配体的对接，那么，第一装配体与其对应的最佳对接区域的相对位置是固定的，第一装配体上粘贴的标识码A与其对应的最佳对接区域的相对位置也是固定的，事先测定待用；

本步骤中，计算机的位姿计算模块结合多节段机械臂与目标子区域的实时相对位置，以及单目摄像头与目标标识码A的实时相对位置，即可计算出多节段机械臂与第一装配体的实时相对位置。

2.如权利要求1所述的核退役机器人末端工具远程换装方法，其特征是：公接头包括液压公接头和/或电气公接头和/或气路公接头，母接头是与公接头相匹配的液压母接头和/或电气母接头和/或气路母接头。