CN106813943B - 一种基于移动机器人的危化溶液自动定位以及定量提取的方法 - Google Patents

Abstract

本发明涉及一种基于移动机器人的危化溶液自动定位以及定量提取的方法，移动小车系统按照规划路径移动至指定危化溶液点，然后发送控制信号给多关节机械臂系统；多关节机械臂系统控制夹具系统的定量取液装置转动到工作位，并移动到危化溶液点合适位置；多关节机械臂系统在视觉超声波检测系统的引导下，通过夹具系统控制定量取液装置进行定量取液操作；将危化溶液转移至危化溶液存储系统；根据规划路径完成其他危化溶液点的危化溶液采集；关闭危化溶液存储系统；多关节机械臂系统各关节回到零点位置。通过引入一种基于移动机器人的危化溶液提取系统，将不同高危环境中使用的固定式危化溶液提取装置替换成防辐射耐腐蚀的移动机器人危化溶液提取装置，从而实现危化溶液高效、定量、可视化提取操作。

Description

一种基于移动机器人的危化溶液自动定位以及定量提取的 方法

技术领域

本发明涉及危化溶液提取及检测领域，具体说是.一种基于移动机器人的危化溶液自动定位以及定量提取的方法。

背景技术

生产制造、医疗卫生、核试验与核电、冶金化工等行业诸多场所会产生大量组分复杂、浓度不均、腐蚀性大、放射性高的危化溶液，对人、动物以及环境极易造成严重伤害。此类危化溶液一般采用隔离的办法存储在封闭空间中，经过收集存储、取样检测、净化处理以及排放等步骤，用稀释或固化等方法处理后，转换成小体积的浓缩物并加以贮藏，待腐蚀性和放射性小于最大允许排放指标后，将其排于环境中进行掩埋或扩散。危化溶液的取样检测是处理过程中非常重要的环节，此阶段将对危化溶液的成分及含量进行检测，只有充分检测后才能找到有效的危化溶液处理方法，只有经过严格处理后才能将其危害降低到最低。

危化溶液取样检测时需采用先进的方法和手段少量提取溶液，进行成分和含量分析。从已公开的记录和资料来看，大部分危化溶液提取采用的是基于真空吸取的方式构建的固定危化溶液提取装置，该装置主要由真空泵、吸取管、控制开关以及摄像头等组成，与危化溶液处理设备一起固定在某个地方，在人工的参与下完成危化溶液的提取，该类装置出于稳定性考虑几乎没有采用精确提取控制的措施，所以难以实现危化溶液的定量和随机抽检。缺少灵活的提取手段和无法精确定量提取等问题成为制约危化溶液处理效率提升的瓶颈，由于采用的是固定式溶液提取装置，不能自由移动操作，当装置发生故障或危化溶液组分变化的情况下，固定式溶液提取装置无法胜任抽检工作，严重时造成危化溶液处理暂停，生产线停机，带来巨大的经济损失。

另外，许多场合没有固定式危化溶液提取设备，当提取的危化溶液种类比较多、距离比较远、工作环境比较恶劣时，需要人进入不同的环境甚至是高危环境中手工操作，出现（1）人较长时间处在恶劣环境中作业，易受到伤害；（2）危化溶液取量不准，作业效率较低；（3）多余危化溶液不易处理等问题。这些问题已严重影响危化溶液检测环节的处理效率和人的安全性。

发明内容

为克服现有技术存在的以上问题，本发明提供了.一种基于移动机器人的危化溶液自动定位以及定量提取的方法，利用移动机器人实现不同高危环境下重复进行定量危化溶液提取的自动化、定量化和标准化操作，从而完全隔离人与高危环境的接触，达到危化溶液充分检测的要求。

本发明由以下技术方案实现：

一种基于移动机器人的危化溶液自动定位以及定量提取的方法，所述移动机器人包括移动小车系统、多关节机械臂系统、夹具系统、视觉超声波检测系统及危化溶液存储系统；所述移动机器人与总控制台系统通讯连接；所述方法包括：

a）移动小车系统按照规划路径从起点移动至指定危化溶液点，然后发送取液指令给多关节机械臂系统；

b）多关节机械臂系统在视觉超声波检测系统的引导下，控制夹具系统进行危化溶液定量取液操作；

d）完成危化溶液定量取液操作后，将危化溶液转移至危化溶液存储系统；

e）根据取液指令和规划路径完成其他危化溶液点的危化溶液采集；

f）关闭危化溶液存储系统；

g）多关节机械臂系统各关节回到零点位置。

进一步的，移动小车系统和多关节机械臂系统均内置有PLC控制器；移动小车系统PLC控制器与多关节机械臂系统PLC控制器为主从控制模式。

进一步的，所述夹具系统包括夹具本体、转动装置、定量取液装置以及气动三爪卡盘装置。

进一步的，所述b）步骤即多关节机械臂系统的PLC控制器控制夹具系统的夹具本体转动，定量取液装置转动至工作位；多关节机械臂抬高至安全高度，在视觉超声波检测系统中的视觉模块的引导下运动到指定危化溶液池里面，确定出平面位置，同时视觉超声波检测系统中的超声波模块开始工作，检测出危化溶液液面与取量装置之间的距离，确定出高度位置；多关节机械臂PLC控制器根据检测到的平面位置和高度位置确定出定量取液装置空间位置坐标，并控制定量取液装置深入危化溶液面以下，进行危化溶液定量吸取。

进一步的，所述定量取液装置包括取液容器本体、检测传感装置及定量取液气动装置；所述取液容器本体通过检测传感装置与多关节机械臂PLC控制器相连；所述取液容器本体外部设置有气动连接口；所述定量取液气动装置通过气动连接口与取液容器本体相连；所述检测传感装置设置在取液容器本体外部；所述取液容器本体内部被移动活塞从上至下依次分为气体室和液体室。

进一步的，所述定量取液操作包括：定量取液气动装置吸气，气体室充满空气，排空液体室；多关节机械臂系统的PLC控制器控制机械臂缓慢向下运动，使定量取液装置深入危化溶液面以下一定距离，气动系统开始排气；检测传感装置检测抽取的危化溶液量，待检测的危化溶液量与设定值相等时，气动装置停止排气，危化溶液提取操作完成。

进一步的，所述危化溶液存储系统包括存储本体、取液量杯、重量传感器以及气动装置；所述取液量杯置于存储本体中；所述重量传感器置于取液量杯底部；所述气动装置一端与移动小车系统PLC控制器相连，另一端与存储本体相连；所述重量传感器与移动小车系统PLC控制器相连。

进一步的，所述d）步骤即：多关节机械臂系统中的PLC控制器发送取液完成信号给危化溶液存储系统，移动小车系统PLC控制器通过重量传感器检测危化溶液存储情况，控制气动系统打开危化溶液存储系统的密封顶盖，做好存储危化溶液准备；多关节机械臂系统中的PLC控制器根据危化溶液存储信息选择新的取液量杯，然后在气动装置的作用下将危化溶液注入选择的取液量杯。

进一步的，步骤f）即移动小车系统PLC控制器通过重量传感器检测危化溶液存储情况，控制气动系统关闭危化溶液存储系统的密封顶盖。

与现有技术相比，本发明的有益效果如下：

本发明利用移动小车系统的移动灵活性和机械臂的操作灵活性，集两者优势设计出用于危化溶液提取的移动机器人系统，该系统可在高危环境中灵活移动、快速操作，完成危化溶液从方案规划到定量提取再到多余危化溶液的处理的全过程处理工艺；

本发明中的移动小车系统PLC控制器与多关节机械臂系统PLC控制器采用主从控制模式，使得相互间控制逻辑严谨、数据传输流畅，易于保证移动小车系统稳定可靠地工作；

本发明利用机器视觉和超声波组成的视觉超声波检测系统进行危化溶液存储空间位置确定，为移动小车和多关节机械臂的移动和操作提供位置数据支持，减少了人在无人的高危环境下手工远程遥控所带来的诸多不确定性，使得危化溶液位置确定和危化溶液提取过程更加智能；

本发明利用集成物体抓取和液体定量提取功能的多功能夹具系统进行危化溶液提取，该系统利用基于真空发生器组件的气动装置为危化溶液提取提供动力，利用基于固态铝电解电容的液面传感器实时检测危化溶液高度，整个夹具系统简单容易、成本低廉，结合危化溶液提取具体步骤，能够快速实现危化溶液的精确定量提取；

本发明利用危化溶液存储系统解决危化溶液提取后的临时存储和安全运输问题，并基于危化溶液存储系统设计了危化溶液循环提取方法，可根据取液指令和规划路径完成不同危化溶液点的危化溶液采集，从而实现多品种、不同量的危化溶液快速提取。

附图说明

图1为本发明的系统工作原理图。

图2为本发明的系统组成框图。

图3为本发明的移动机器人结构图。

图4为本发明的移动机器人系统控制结构图。

图5为本发明的控制指令及传递过程网状图。

图6为本发明的无线通讯系统网络拓扑图。

图7为本发明的总控制台系统软硬件框架图。

图8为本发明的总控制台软硬件网络架构。

图9为本发明的本发明的总控制台外形结构图。

图10为本发明的移动小车系统模块框图。

图11为本发明的移动小车本体内部结构图。

图12为本发明的多关节机械臂系统模块框图。

图13为本发明的夹具装置系统结构图。

图14为本发明的视觉超声波检测组成及原理图。

图15为本发明的危化溶液存储系统结构图。

图16为本发明的电源系统模块构成图。

图17为本发明的移动机器人危化溶液提取整体流程图。

图18为本发明的移动机器人系统状态检测和初始化流程。

图19为本发明的指令下达及数据通讯过程图。

图20为本发明的移动路径过程规划图。

图21为本发明的危化溶液自动定位和定量提取过程。

图22为本发明的危化溶液运输和定点放液流程。

图23为本发明的多余危化溶液自动处理流程。

具体实施方式

以下结合附图和具体实施方式进一步说明本发明。

根据危化溶液的特点和自动定量提取的流程，考虑操作安全性以及功能的可靠实现，设计一种基于移动机器人的高危环境下危化溶液自动定量提取系统，工作原理如图1所示。整体采用控制机构和执行机构分离的思想，移动机器人系统作为执行机构放置在高危环境内部，总控制台作为控制机构放在高危环境外部，不但适合一般溶液随机定量提取要求，还适于放射性高、化学成分不确定、品种类型多、安全要求高的危化溶液随机定量提取要求的场景，具有良好的灵活性。

如图2所示：该系统包括总控制台系统、无线通讯数据传输系统、移动小车系统、多关节机械臂系统、多功能夹具系统、视觉超声波检测系统、危化溶液存储系统及电源系统等。其中，移动小车系统、多关节机械臂系统、多功能夹具系统、危化溶液存储系统以及视觉超声波检测系统构成移动机器人系统。

如图3所示：所述移动机器人包括移动小车系统、多关节机械臂系统、夹具系统、视觉超声波检测系统及危化溶液存储系统，且多关节机械臂系统、夹具系统、视觉超声波检测系统、危化溶液存储系统均布置于移动小车系统上；所述总控制台系统基于通讯网络与移动小车系统通信连接，并通过移动小车系统获取移动机器人上各系统状态参数，同时发送取液信息和运动指令给移动小车系统；所述移动小车系统接收并转发总控制台系统发出的取液信息和运动指令，实现移动机器人在危化溶液采集和放置线路上的移动；所述移动小车系统分别与多关节机械臂系统和危化溶液存储系统相连，所述多关节机械臂系统与夹具系统相连，所述视频超声波检测系统通过通讯网络实现与总控制台系统通信连接。

图4为移动机器人的系统结构控制图，总控制台系统作为指令发送和实时数据处理中心，通过通讯模块实时与移动小车系统、多关节机械臂系统等主系统，视觉超声波检测系统、多功能夹具系统以及危化溶液存储系统等辅助系统联系起来，构成高危环境下移动机器人控制系统。

具体的，总控制台系统通过有线与无线的混合局域网与无线通讯模块连接，无线通讯模块通过以太网接口与移动小车系统的PLC控制器相连。移动小车系统与多关节机械臂系统采用主从控制模式，即移动小车系统的PLC控制器作为主站，多关节机械臂系统的PLC控制器作为从站，两者通过Prifibus DP模块接口连接，用于执行移动和操作行为，且多关节机械臂基座安装在移动小车顶部前端。危化溶液存储系统安装在移动小车顶部后端，其量杯重量传感器和气动密封盖电磁阀通过O/I模块与移动小车PLC控制器集成在一起，用于危化溶液安全存储和搬运。多功能夹具系统安装在机械臂末端，其检测传感器、气动系统电磁阀等通过O/I模块与机械臂控制器集成在一起，用于危化溶液定量提取和夹取。安装在移动小车内部的电源系统为主系统和辅助系统提供移动、操作、检测所需的能量，由无线充电装置、锂离子电池组以及电源管理模块等三部分组成，其中电源管理模块为由MCU微控单元、PMIC电源管理集成电路以及各种传感器组成的电源控制装置。

图5为本发明的控制指令及传递过程网状图，系统控制指令及传递过程描述为，工作时总控制台通过指令输入与发送模块经无线传输装置发送危化溶液提取参数信号、动作指令信号给移动小车系统、视觉超声波检测系统以及电源系统，三大系统及其辅助系统自检无误后开始工作。移动小车按照指令移动，完成规定任务后发送动作指令给多关节机械臂，使机械臂进行相应的危化溶液提取与抓取操作，机械臂动作的同时危化溶液存储系统按照移动小车的控制指令配合机械臂工作。另外，视觉超声波检测系统将现场采集到的视频信息和超声波数据采集信息返回给主控台。电源系统给各个子系统供电，并把电池状态反馈给总控台。

图6为无线通讯系统网络拓扑图，在高危环境内外，构建基于IEEE 802.11b/g/a/h通讯协议的WIFI无线网络，通过WIFI无线网络为数据载体，连接总控制台、移动小车系统、多关节机械臂系统、视觉超声波检测系统等，构成高危环境下的控制数据、视频数据、状态数据等传输的有效通道。

通讯系统主要由无线AP、无线数据收发装置、局域网等组成，其中局域网是基于IEEE802.3通讯协议构建的以太网，总控制台通过有线的方式直接连接局域网；无线AP和无线数据收发装置为可寻址的装置，无线AP通过有线方式直接连接局域网，无线通讯装置一端与移动小车系统、视觉超声波检测系统、电源系统等通过以太网接口连接，另一端通过WIFI网络与AP无线连接，从而实现控制数据、视频数据、状态数据的高速传输。

图7为本发明的总控制台系统软硬件框架图，总控制台由显示器、主控计算机、实时通讯服务器、数据服务器、视频服务器、网络通讯模块等硬件和监控应用系统、后台数据库、服务软件等软件构成。通过有线与无线混合局域网的方式与移动小车系统、多关节机械臂系统、危化溶液存储系统、视觉超声波检测系统等实时通讯，获取其状态参数，同时发送取液信息和运动指令给各个模块，实现移动机器人的远程遥控。

监控应用系统基于Windows平台开发，安装在主控计算机上，具有基础数据维护模块、取液信息输入和指令发送模块、移动机器人工作状态监控模块、视觉超声波监控模块、安全防护报警模块以及实时数据通讯模块等六大模块。

图8为总控制台系统的软硬件网络架构，主控计算机、数据服务器、视频服务器等以总线的形式连接在以太网上，通过网络通讯模块，主控计算机与各个服务器实时通讯，便于监控软件进行数据查询和处理。实时通讯服务器上面安装有通讯服务软件，及时抓取主控计算机下达的指令给各个子系统，同时抓取各个子系统反馈的状态数据和传感数据，并存储在数据服务器和视频服务器上。数据服务器上安装关系型数据库，为监控软件提供数据存储支撑，实时存储各项操作数据、反馈数据、基础维护数据、安全运行状态数据、发送指令历史数据等。视频服务器实时存储视觉超声波系统采集到的视频信息和超声波高度检测信息。

图9为本发明的总控制台的一种外形结构图，采用人机工程学思想设计外观，由两个显示器、一个操作台以及总控台壳体组成，其中两个显示器一个用于可视化监控，一个用于控制指令发送和接收；总控台壳体由不锈钢材料制成，表面敷设1毫米厚铅皮，起防辐射、耐腐蚀作用。

图10为本发明的移动小车系统模块框图，移动小车系统作为整个系统的移动装置，包括机械本体、控制模块、驱动模块、导航模块、通讯模块等五个主要部分。所述移动小车系统包括机械本体、控制模块、驱动模块、导航模块及通讯模块；所述机械本体用于提供移动机器人运动的物理结构；所述控制模块通过通讯模块和总控制台系统相连，所述控制模块通过驱动模块与机械本体相连；所述导航模块与控制模块相连。

图11为本发明的移动小车系统本体内部结构图，移动小车机械本体，由小车本体、转向机构以及传感部件组成，其中小车本体呈长方体形状，车体框架采用铝合金型材，进行全封闭放辐射处理，车体外部敷设1~2mm厚的铅皮作为屏蔽材料；小车顶部为主要承载部分，靠前位置有沿圆周均布四个螺纹孔的多关节机械臂安装孔，通过螺栓连接使移动小车与多关节机械臂的基座固定板连在一起；车体顶部靠后位置有危化溶液存储装置安装座，通过螺栓与危化溶液存储装置上的安装座刚性连接；车体左右两边底部分布有两对对称的四个麦克拉姆轮，构成小车的移动部分；车体正右侧布置有信号收发天线，信号收发天线与小车内部的无线通讯装置连接，构成小车的无线通讯模块。

小车内部根据合理利用空间的原则，为三层安装结构，逻辑连接关系参见“移动机器人系统控制结构图”，第一层为上层，主要为多关节机械臂的控制部件、无线通讯装置和视觉超声波处理装置，具体多关节机械臂的控制部件包括1个多关节机械臂控制器、1个运动控制模块、4个机械臂关节的伺服驱动器，无线通讯装置为1套基于无线WIFI的无线通讯装置，视觉超声波处理装置为1套基于CCD相机和超声波的位置检测装置；第二层为中间层，主要为移动小车的控制部件、气动系统，具体移动小车的控制部件包括1个移动小车控制器、1个运动控制模块、4个移动小车轮子的伺服驱动器，气动系统包括1套危化溶液存储装置气动装置，1套多功能夹具装置三爪气动夹具气动装置， 1套多功能夹具装置定量取液装置的气动装置；第三层为底层，为各个装置提供动力的电源装置，具体的有一组锂电池串和1个电源管理装置。小车底部四角方向布置有4个麦克拉姆轮伺服电机和电机减速器、中间位置布置有一套磁感应导航用的导航传感器和地标传感器、一个无线充电接收器。

移动小车转向机构采用基于麦克拉姆轮的四轮独立驱动的方式进行小车运动控制。麦克拉姆轮由两个轮毂和一定数量的小辊子组成，采用两端支撑结构，小辊子轴线与轮毂轴线夹角为±45°，两者材料均采用耐腐蚀防辐射材料。四个麦克拉姆轮中两个左旋结构和两个右旋结构，以两左两右四轮对称布置的方式安装在移动小车车体左右两边；每个麦克拉姆轮与一个直流伺服电机和电机减速器直连，通过对四个轮子不同的速度控制，实现小车不同方向的运动。

控制模块：包括PLC控制器和运动控制模块，移动小车采用PLC控制器加运动控制模块等方式进行运动控制，其中PLC主要负责与总控制台通讯，通过WIFI通讯方式及时接收总控制台发出的控制指令和反馈小车运行状态数据；运动控制模块负责执行PLC接收的信号指令，对移动小车反馈的导航信号、位置信号进行实时处理和计算，输出控制信号给直流伺服驱动器。另外，移动小车整体采用上位机与下位机结合的开放式控制模式，其中上位机为总控制台系统，下位机为移动小车系统的PLC控制器。

驱动模块：移动小车驱动采用直流伺服电机驱动器和直流伺服电机，直流伺服电机驱动器一端与移动小车PLC控制器中的运动控制模块相连，一端与直流伺服电机相连。PLC控制器的运动控制模块发送数字量高速脉冲信号给伺服驱动器，伺服驱动器采用位置控制模式根据控制信号和伺服电机反馈的信号产生脉冲形式的PWM信号，经功率放大后驱动伺服电机，伺服电机根据伺服驱动器发出的脉冲和方向信号进行启动、停止、反转以及变速等动作。

导航模块：该模块由磁传感器和铺设在地面的磁条组成，其中磁传感器分为磁导传感器和磁地标传感器，磁条分为导引磁条和地标磁条。磁感应对高危环境的敏感度不高，故采用磁条导航的方式设计移动小车的导航模块，小车底部靠前位置安装有磁导航传感器和地标传感器，用于检测在地面预定铺设的导引磁条和地标磁条。移动小车运行时，磁导航传感器垂直于磁条上方一定距离，采集磁条的磁场强度，判断磁条相对于磁导航传感器偏离位置，据此移动小车自动调整，确保沿磁条前行。地标传感器不断读取地标磁条，并据此判断运行位置和改变运行状态。地标磁条垂直于导航磁条方向，贴在导航磁条旁边的地面上。

通讯模块：由无线通讯装置和信号收发天线组成，其中无线通讯装置为无线数据收发装置，安装在移动小车内部第一层，信号收发天线安装在移动小车外部右侧。无线通讯模块一端采用无线局域网标准协议IEEE 802.11b/g/a/h，与总控制台实时无线连接，及时获取总控台发出的取液指令和运动指令，同时将移动小车以及关联系统的状态及时报告给总控台。无线通讯模块另一端与移动小车PLC控制器通过以太网口相连，及时将总控台发出的取液指令和运动指令传递给移动小车PLC，同时将移动小车PLC收到的反馈信号传递给总控制台。

图12为本发明的多关节机械臂系统模块框图，所述多关节机械臂系统是根据高危环境危化溶液定量提取特点设计的一个集机械、控制、电气于一体的开链连杆式和直角坐标式混合型关节机器人，工作范围最远达到2米，通过螺栓安装在移动小车顶部，与移动小车协作完成危化溶液提起、危化溶液转运、危化溶液放置等工作。主要包括机械本体、伺服驱动以及运动控制部分。

机械本体由执行单元、机械臂本体、传感部件组成。执行单元由伺服电机、减速器、轴承及轴承座等部件组成。传感部件为检测各个轴伺服电机的角度、转速、电流、电压等参数的传感器。机械臂本体由基座、底座、大臂、小臂以及末端伸缩轴构成，共有四个自由度，其中基座与底座、底座与大臂、大臂与小臂之间为转动副，小臂与末端伸缩轴之间为移动副，且小臂与末端伸缩轴之间夹角保持为90°。

机械臂基座采用矩形截面的中空铝制铸件，内部安装底座的直流伺服驱动电机、减速器、轴承以及轴承座等零部件，基座底部为一带有沿圆周均布四个螺纹孔的固定板，此固定板与移动小车上的多关节臂安装孔通过螺栓刚性连接在一起。底座采用圆形截面的中空铝制铸件，内部安装有大臂的直流伺服驱动电机、减速器、轴承以及轴承座等零部件。大臂采用圆形截面的中空薄壁铝制铸件，内部安装有小臂的直流伺服驱动电机、减速器、轴承以及轴承座等零部件。小臂采用圆形截面的实心铝制铸件，末尾安装有末端伸缩轴的执行部件，即伺服电机、同步带、螺母滚珠丝杠等零部件。末端伸缩轴由伺服电机、同步带、螺母滚珠丝杠和末端执行器组成，在滚珠丝杠运动副里面采用螺母驱动的方式，使丝杠螺母在直流伺服电机经同步带驱动下产生旋转运动，从而带动丝杠进行垂直方向的直线运动。

机械本体各个轴及伺服电机表面均敷设铅皮，放置在移动小车外部；控制部分和伺服驱动部分放置在移动小车内部，减轻辐射的影响。

图13为本发明的多功能夹具结构图，所述多功能夹具装置，是一个集定量取液和夹取搬运功能于一体的电、气控制装置，通过螺栓刚性安装在多关节机械臂末端，外观和内部结构如下图所示。

多功能夹具装置包括一个夹具本体、一个转动装置、一个气动三爪卡盘装置以及一个定量取液装置。

多功能夹具装置由机械臂PLC控制器控制，动作过程描述为多关节机械臂PLC控制器接收到移动小车PLC控制器发送的取液指令或抓取指令，若为取液指令，则多关节机械臂控制器控制转动装置将定量取液装置转到竖直向下的位置，再控制定量取液装置的气动电磁阀打开，则危化溶液逐渐进入定量取液装置。与此同时，定量取液装置中的气体流量信息、压力信息、危化溶液高度信息通过相应传感器快速反馈到多关节机械臂控制器，达到设定量后停止动作。若为抓取指令，则多关节机械臂控制器控制转动装置将三爪卡盘装置转到竖直向下的位置，再控制三爪卡盘气动电磁阀打开，实现三爪卡盘的张开和收紧，达到抓取的目的，与此同时，三爪卡盘装置中的卡夹取压力信息通过相应传感器快速反馈到多关节机械臂控制器，与气动电磁阀配合，实现抓取力的精确控制。

所述夹具本体正面呈正八边形，分为对称两半，对称面与水平面成45°夹角。夹具本体上部通过法兰连接在多关节机械臂第四轴末端，下部在水平方向上安装一个自定心三爪卡盘装置，在垂直方向上安装一个定量取液装置。

所述转动装置由旋转气缸、气缸活塞、气缸固定件、消声器、位置传感器等组成，旋转气缸通过气缸固定件安装在夹具本体上半部内，气缸活塞与夹具本体下半部固定相连，工作时由旋转气缸提供动力，通过气缸180°转动实现夹具本体两半之间相对转动，从而实现三爪卡盘装置与定量取液装置的工具转换。位置传感器用来检测气缸活塞是否转动了180°位置，并将到位信息传递给多关节机械臂PLC控制器。

所述气动三爪卡盘装置，为圆柱形气动自定心三爪装置，由本体、3个卡爪、3个压力传感器、一套气动装置组成。

三爪卡盘装置本体呈圆柱形，内部有气路、气动连接口及卡爪导向槽；3个卡爪均布在圆柱形本体卡爪导向槽上，采用不锈钢材料，上镶有防滑耐酸碱柔性材料，便于取液杯的夹取操作。压力传感器安装在卡爪内侧，由防滑耐酸碱柔性材料保护，用于监测抓取盛放危化溶液的量杯时的抓取力，并将压力信息传递给多关节机械臂的PLC控制器。

三爪卡盘气动装置包括一个3位5通数字式电磁阀、两个双向速度控制阀、一个压力控制阀以及管线。气路连接关系为，首先一条气路通过管线与压力控制阀相连，再与电磁阀相连，分成两条气路，接着两条气路管线与两个双向速度控制阀相连，最后两条管线与本体上的气动连接口相连。其中数字式电磁阀与多关节机械臂的PLC控制器相连，通过多关节机械臂的PLC控制器控制数字式电磁阀，进而控制整条气路的通断，实现卡爪同时收紧和张开的功能。气动装置安装在移动小车内部第二层。

三爪卡盘通过工字形法兰螺纹连接在八边形夹具本体一边上，非工作状态时三爪卡盘轴线与地面平行，工作状态时三爪卡盘轴线与地面垂直。

所述定量取液装置，包括一个取液容器本体、一套检测传感装置、一套气动装置。

取液容器本体是一个圆柱状耐腐蚀玻璃钢容器，本体左侧上部有一个气动系统连接口，本体右侧为液面位置检测传感装置，本体内部被移动活塞分为上、下容器室。上容器室为气体室，里面安装两个弹簧固定端子和一个压缩弹簧，可保证气体室稳定有效工作。下容器室为液体室，用于盛放提取的危化溶液。本体中间为移动活塞，活塞两头放置密封圈，密封圈可有效保证气体室与液体室的隔断。

检测传感装置是一套液面位置检测传感器，呈长条状，粘贴在取液容器本体右侧，用来检测液体抽取过程中液面的高度信息，经数据处理和转换后传递给多关节机械臂的PLC控制器。液面位置检测传感器是由粘接剂、固态电容组件、数据转换电路等组成的液面检测装置，固态电容组件由N组固态铝电解电容经一定组合而成，可根据液位的高度变化发生电容大小变化，再经数据转换电路将电容大小变化转换成数字量，从而实现液位的实时监测。固态电容组件通过粘接剂粘贴在取液容器本体右侧，外面敷设一层耐腐蚀防辐射的铅皮材料。

气动装置包括一个3位3通数字式电磁阀、一个真空发生器组件、一个双向速度控制阀、一个流量传感器、一个气压传感器以及管线，其中3位3通数字式电磁阀有两个出气口，真空发生器组件有一个进气口，一个出气口。气动装置的连接方式为电磁阀其中一个出气口与真空发生器组件的进气口相连，另一个出气口与真空发生器组件的出气口相连，同时真空发生器组件的出气口与速度控制阀相连，中间连接一个监控气路中气体流速的流量传感器，速度控制阀取液容器本体相连，中间连接一个监控气路压力的气压传感器。气动装置有一个气源进气口和一个出气口，气源进气口连接外部气源，出气口与定量取液装置中的取液容器本体相连，气动装置中的数字式电磁阀的控制端与多关节机械臂的PLC控制器相连，实现多关节机械臂的PLC控制气动装置气路的通断。气动装置的工作方式为气源经电磁阀流过真空发生器组件时产生正压或负压，使取液容器本体气体室内的压力大于或小于液体室内的压力，活塞在压力差作用下向下或向上移动，实现液体的精确提取和排出。气动装置安装在移动小车内部第二层。

定量取液装置通过工字形法兰螺纹连接在八边形夹具本体一边上，工作状态时其中心轴线与地面保持垂直。

图14为本发明的视觉超声波检测工作原理图，视觉超声波检测系统，是一套无线远程监控系统，是移动机器人系统的“眼睛”，来用监视移动路径上的障碍、计算移动机器人的空间位置。该系统主要由总控制台、无线通讯模块以及数据采集处理模块组成，其中数据采集处理模块由处理单元、视觉模块及超声波模块组成。

视觉超声波检测系统融合视觉和超声波技术，使视觉模块与超声波模块配合工作，计算空间位置坐标。其原理为用工业CCD相机获取高危环境下的二维图像信息，经图像处理转换成平面XY坐标信息，再由超声波传感器获取高度方向上的信息，即Z坐标信息，两者经逻辑单元处理后可获得空间位置坐标，移动小车系统根据空间坐标信息进行精确定位。

总控制台监控应用系统有视觉超声波监控模块，通过无线WIFI与无线通讯模块与数据采集模块相连，数据采集模块中的处理单元采用嵌入式ARM处理器，实时获取工业CCD相机采集到的视频信息和超声波位移传感器采集到的高度信息，并通过以太网接口和无线通讯模块，将数据反馈给总控制台，总控制台将数据放在视频服务器，便于监控模块进行环境可视化监控和图像空间坐标计算。

数据采集处理装置包括两块直角安装板、一张图像采集卡、2个工业CCD传感器、一个超声波位移传感器、一个超声波模数转换装置、一个嵌入式ARM处理器以及一个无线通讯装置，其中CCD传感器通过图像采集卡与嵌入式ARM处理器相连，超声波传感器通过模数转换装置与嵌入式ARM处理器相连，然后嵌入式ARM处理器与无线通讯装置相连。直角安装板其中一块安装在机械臂末端与夹具装置之间，其前方安装一个工业CCD传感器和一个超声波位移传感器，两者配合进行平面位置和危化溶液液面的高度位置的数据采集。另一块直角安装板安装在夹具装置右侧，其上安装一个工业CCD传感器，用于实时监视危化溶液定量提取过程及装置中液面高度。

图像采集卡、超声波模数转换装置、嵌入式ARM处理器、无线通讯装置安装在移动小车内部，其中无线通讯装置通过无线WIFI 采用802.11b/g/a/h标准协议与总控制台视频超声波检测模块实时无线连接，将图像信息和超声波数字信息及时传递出去。

图15为本发明的危化溶液存储系统结构图。所述危化溶液存储装置，主要用来安全存储和可靠转运移动机器人定量提取到的危化溶液，具体包括一个方形存储本体、3个取液量杯、3个重量传感器、一套气动装置。

存储本体为耐腐蚀耐辐射的不锈钢材质，主要由容腔本体、活动气缸、连杆机构、密封顶盖、密封软垫组成。容腔本体呈长方体，中间有三个空腔，可容纳3个钢化玻璃材质的取液量杯。容腔本体上端面对称中心靠后位置间隔一定距离布置两个一大一小的长方体凸起，小长方体凸起用于连接，大长方体凸起用于限制密封顶盖空间范围，使其与容腔本体上端面保持平行。容腔本体上方是方形的气动密封盖，气动密封盖底部放置3个比取液量杯口径略大的密封软垫，正常密封后可防止危化溶液运输过程中溅落出来。气动密封盖尾部固定连杆机构，连杆中间位置与小长方体凸起通过铰链1形成转动副，连杆尾部与一个活动气缸的活塞通过铰链2形成转动副连接。容腔本体两侧底部有四个安装座，与移动小车上的存储装置安装座用螺栓刚性连接。

活动气缸由气动活塞和气缸缸体组成，气动活塞呈圆柱状，与连杆机构末端通过铰链2形成转动副；气缸缸体呈圆柱状，右侧有两个气动连接口，用于连接气动装置；气缸缸体底部与容腔本体后端面通过铰链3形成转动副，使活动气缸可以绕铰链3自由转动。

取液量杯采用透明的钢化玻璃材质，与存储本体上的容腔配套，用来存储不同种类的液体。重量传感器采用圆板型电阻应变式重量传感器，通过螺纹连接固定在取液量杯容腔底部，与进入容腔的取液量杯形成面接触。其测量数值经A/D转换后通过数据线连接到移动小车PLC控制器，以便时刻监测取液量杯中危化溶液的动态重量。

存储装置中的气动装置包括一个3位5通数字式电磁阀、两个双向速度控制阀、一个压力控制阀以及管线。气路连接关系为，首先一条气路通过管线与压力控制阀相连，再与电磁阀相连，分成两条气路，接着两条气路管线与两个双向速度控制阀相连，最后两条管线与气缸的气动连接口相连。其中数字式电磁阀由移动小车PLC控制器控制，在多关节机械臂系统进行取液、放液等相关动作时，移动小车PLC控制器发送相应控制信号给气动装置电磁阀控制端，驱动密封顶盖配合机械臂执行打开和关闭操作。该气动装置安装在移动小车内部第二层。

存储装置与移动小车控制器的连接示意图如下图所示，移动小车控制器与存储装置中的电磁阀连接，控制气路通断，实现密封顶盖的打开和关闭；重量传感器通过AD转换器与移动小车PLC控制器相连，实时获取取液过程中危化溶液的重量信息，通过反馈实现危化溶液精确量化控制。

图16为本发明的电源系统模块构成图。所述电源系统，用来为移动机器人系统提供移动和操作的电力能源，由蓄电池、无线充电装置以及电源管理系统组成，其中蓄电池为高密度锂电池串，直接为移动小车、多关节机械臂等提供直流电源；无线充电装置采用磁耦合谐振的能量传输方式，对移动机器人的供电电池进行非接触无线充电，由发射模块、接收模块等两部分组成；电源管理系统是一个电池串管理系统，由数据采集模块、控制保护模块、存储模块、均衡模块等组成，用来进行电池单体状态监控、电池单体均衡、电池充电管理以及电池安全保护等。

移动小车无线充电系统由电源发射模块和电源接收模块组成，电源发射模块由无线发送装置和发送电源管理模块组成，其中无线发送装置由高频激励源、谐振发射电路以及中继电路组成，整个装置安装于安全区域地面上，构成电源发射端；电源接收模块由无线接收装置和接收电源管理模块组成，其中无线接收装置由整流稳压电路、谐振接收电路和电源管理模块组成，安装于移动小车底部，构成电源接收端。

移动机器人电源管理系统实时监测所携带电池剩余电量，并通过无线WIFI实时上报总控制台，如果在非工作状态时剩余电量低于一定阈值，则总控台分配任务时会提示移动机器人系统电量不足，需要充电；如果在执行工作中电量低于一定阈值，则移动机械人向总控台发出低电量告警，中断当前的取液或移动操作，保存当前任务状态，等待总控台下达充电指令。移动机器人充电时，先沿导航磁带自动移动到充电发射装置安装位置，此时电源输入端将交流市电经无线充电装置转换成24V直流电，并存储在锂电池组里。完成充电后，移动机器人恢复之前的任务状态，继续进行相应操作。

基于上述系统的组成，我们提出一种危化溶液定量提取方法，该方法适用于高危危化溶液取样检测阶段，通过引入一种基于移动机器人的危化溶液提取系统，将高危环境中使用的固定式危化溶液提取装置替换成防辐射耐腐蚀的移动机器人危化溶液提取装置，从而实现危化溶液高效、定量、可视化提取操作。

该方法所涉及的危化溶液提取系统包括一个总控制台、一套无线网络通讯系统、一个集成移动小车、多关节机械臂、多功能夹具、存储装置以及视觉超声波检测系统的移动机器人系统。采用控制机构和执行机构分离的思想，移动机器人系统作为执行机构放置在高危环境内部，总控制台作为控制机构放在高危环境外部，总控制台通过无线网络通讯系统实时控制高危环境中的移动机器人系统。

该方法所涉及的危化溶液提取系统中的移动小车和多关节机械臂等本体采用质轻耐腐蚀材料，在各本体表面敷设耐辐射的铅皮；控制系统采用屏蔽性好抗干扰能力强的PLC，并密封在移动小车内部，完全与高危环境隔离，只让伺服电机、步进电机等电气执行部件处在高危环境中。

图17为本发明的移动机器人危化溶液提取整体流程图。一种基于移动机器人的危化溶液处理方法包括移动机器人系统状态检测及初始化工作的方法；总控制台系统危化溶液抽取指令下达的方法；移动路径自动规划的方法；危化溶液自动定位以及定量提取的方法；危化溶液安全存储、运输及定点放置的方法；多余危化溶液自动处理的方法；移动机器人先按照高危环境外部总控制台给定指令移动到不同的危化溶液区自动进行危化溶液定量提取，并用移动小车上的危化溶液存储装置存放；再把危化溶液运输到检测指定位置完成定点危化溶液放置任务，等待人工拿走危化溶液进行后续的各项检测工作；最后移动机器人将处理过的或多余危化溶液运输到危化溶液处理槽并按程序处理。

图18为本发明的移动机器人系统状态检测和初始化流程。该方法中考虑高危环境对铺在地上的磁带影响较小，故移动小车采用磁带感应的方式进行导航移动。事先在地面上按照系统原理图用导航磁带铺设出小车行进路线，规划出起始点、检测点、中间点、危化溶液池点以及多余危化溶液处理点等关键位置点，并用地标磁带标定出关键位置点。

该方法涉及移动小车从起始点经中间点和危化溶液点到检测点的移动操作，故需要在移动小车控制系统内部事先编制和存储路径移动程序块。同时也涉及利用机械臂进行危化溶液定量提取、危化溶液放回存储装置、检测台定点放液、多余危化溶液自动夹取、多余危化溶液处理等典型操作，故需要事先在机械臂控制系统中编制和储存相应操作程序块。

进行危化溶液提取之前，需进行导航磁带铺设，即先在地面上按照系统原理图用导航磁带铺设出小车移动路线，规划出起始点A、中间点B、危化溶液池点C、检测点D、以及危化溶液处理槽点E等关键位置点，其中起始点只有一个，标记为A；中间点有两个，标记为B1、B2；危化溶液池点有三个，标记为C1、C2、C3；检测点有三个，标记为D1、D2、D3；危化溶液处理槽点有一个，标记为E。然后用与关键点对应的地标磁带在地面上标定出关键位置点。

磁带铺设后，进行多关节机械臂坐标系标定，具体包括多关节机械臂坐标系建立和零点位置设定，其中多关节机械臂坐标系包括基本坐标系Base、参考坐标系Ref、工具坐标系Tool，基本坐标系Base设置在多关节机械臂基座底部中心，考坐标系Ref设置在多关节机械臂末端伸缩轴底部中心，工具坐标系Tool1设置在定量取液装置底部中心，工具坐标系Tool2设置在气动三爪卡盘装置卡盘上表面中心。坐标系建立之后进行多关节机械臂零点位置设置，以多关节机械臂的小臂侧面与顶面分别与移动小车侧面与顶面保持平行、多功能夹具与移动小车和地面保持一定安全距离为准则。

磁带铺设后，进行多关节机械臂坐标系标定，具体包括多关节机械臂坐标系建立和零点位置设定，其中多关节机械臂坐标系包括基本坐标系Base、参考坐标系Ref、工具坐标系Tool，基本坐标系Base设置在多关节机械臂基座底部中心，考坐标系Ref设置在多关节机械臂末端伸缩轴底部中心，工具坐标系Tool1设置在定量取液装置底部中心，工具坐标系Tool2设置在气动三爪卡盘装置卡盘上表面中心。坐标系建立之后进行多关节机械臂零点位置设置，以多关节机械臂的小臂侧面与顶面分别与移动小车侧面与顶面保持平行、多功能夹具与移动小车和地面保持一定安全距离为准则。

多关节机械臂坐标标定之后，进行高危环境状态检测、移动机器人系统状态检测、人工取液工具准备等内容，保证危化溶液提取的环境参数在合理范围以及危化溶液提取装置正常可用。危化溶液环境状态检测包括，通过安装在高危环境下的环境监控传感器及时获取环境状态参数，并保存在历史数据库中，便于历史环境数据查询。移动机器人系统状态检测包括，总控制台给移动机器人系统发送自检指令，则移动机器人系统进行电池电量查询、移动小车状态查询、机器臂各关节状态查询、多功能夹具状态查询、视频超声波检测系统查询等功能模块自检，所有模块检查后，将状态参数反馈总控制台。同时需事先进行检测台人工取液准备，准备防辐射耐腐蚀的橡胶手套，用于取出移动机器人按指令要求取出的危化溶液；检查指定放液点是否被占用，没有则将取液量杯放置在检测台指定位置。

另外，移动机器人系统自检一切正常后开始初始化工作，即移动小车回到路径移动起始点，机械臂各个关节回到零点位置，多功能夹具危化溶液提取装置垂直于地面，危化溶液存储装置密封盖关闭，危化溶液存储系统密封盖关闭，视频超声波检测系统开始准备工作等。

初始化工作后，移动小车进入空闲状态，等待总控制台下达进一步的指令。

图19为本发明的指令下达及数据通讯过程图。移动机器人系统各项准备工作完成以后，则要根据检测需求设定检测用量方案，包括检测液体编号、检测液体量、检测液指定放液点等三个参数，再在总控制台应用监控系统中的取液信息输入和指令发送模块中输入三个检测用量参数，总控制台根据移动机器人系统中的危化溶液存储装置允许的取液量杯数量和体积、检测台被占用情况以及危化溶液区危化溶液存储类型和存储量等信息检查用量方案的合理性。

方案合理性检查条件及详细步骤：

（1）当前存储装置中的取液量杯的数量为N个，每个体积M升，那么检测液体编号的个数<=N，每种检测液体量<=M升；

（2）用于放置检测液的检测台中有P个检测点，且有Q个被占用，那么检测液体编号的个数<=P-Q；

（3）危化溶液区存储的危化溶液有R种类型，每种有T升存储量，且每种存储量不能小于S升，那么被允许提取的检测液体编号个数<=R，且每种检测液体量<=T-S升。

方案合理性检查之后，总控制台根据检测用量参数确定出从起始点A到危化溶液处理槽点E等关键位置点。详细地规划过程为，检测用量参数包括检测液体编号、检测液体量、检测液指定放液点，那么根据检测液体编号确定危化溶液池点，根据检测液指定放液点确定检测点，在总控制台监控应用系统取液信息输入和指令发送模块里面根据这些条件确定出危化溶液池点C和检测点D，在和固定的起始点A，中间点B以及危化溶液处理槽点E串联起来，可确定出从A到E，再回到A这样的关键位置点。

关键位置点确定之后，发送关键位置点和用量参数。总控制台通过无线通讯系统将关键位置点和检测用量参数发送给移动机器人系统中的移动小车，移动小车接收到相关信息后，反馈给总控制台信息接受情况，等待总控制台发送启动或停止等下一步行动指令。

图20为本发明的移动路径过程规划图。总控制台通过无线通讯系统发送启动指令给移动小车，即发送一个触发移动小车开始工作的程序指令；移动小车接收启动指令后根据总控制台先前发送的关键位置点信息进行移动路径规划，完成后将规划信息存储在移动小车PLC控制器；接着移动小车PLC控制器将规划出的工作命令和液体提取参数等信息发送给多关节机械臂系统PLC控制器；机械臂PLC控制器接收到信息后，进行多关节机械臂操作路径规划，完成后将规划信息存储在多关节机械臂PLC控制器。移动机器人系统规划完成后，反馈给总控制台规划情况，等待总控制台发送下一步行动指令。

移动小车的移动路径规划是指：

1）在移动小车PLC控制器内部编制路径规划程序块，该程序块首先接收总控制台发送的启动指令后根据总控制台发送的关键位置点运算移动回路、运动方向、以及移动速度等运动参数；

2）利用路径规划程序块根据高危环境下设置的空间坐标运算移动小车关键位置点的设计位置信息，作为导航传感器和地标传感器检测到的实际位置信息的比对参考点；

3）利用路径规划程序块在关键位置点之间导航路径两边规划1个辅助位置点，并运算出局部辅助移动回路、运动方向、以及移动速度等运动参数等，当导航路径被阻碍时，移动小车可选用辅助回路绕开障碍继续移动；

4）在路径规划程序块内部添加移动小车导航数据处理子程序块，该子程序块被用于处理磁导航传感器和磁地标传感器检测到的数据，确保移动小车沿着导航磁条或辅助移动回路移动；

5）利用路径规划程序块规划出位置与信号映射，即移动小车移动到不同关键位置点给多关节机械臂PLC控制器发送的工作命令和危化溶液提取参数，给总控制台反馈的实际位置信息和设备运行状况，其中工作命令包括危化溶液定量提取、危化溶液放回存储装置、检测台定点放液、多余危化溶液自动夹取、多余危化溶液倾倒等5个典型的多关节机械臂操作工作命令，可分别用M01~ M05标识，危化溶液提取参数主要包括每种危化溶液的提取量，可分别用P01~ P03标识。

多关节机械臂的操作规划是指：

1）在多关节机械臂PLC内部编制操作规划程序块，该程序块首先接收来自移动小车发送的工作命令和危化溶液提取参数等信息；

2）利用操作规划程序块规划机械臂典型操作过程，根据实际危化溶液提取及处理操作特征，提取危化溶液定量提取、危化溶液放回存储装置、检测台定点放液、多余危化溶液自动夹取、多余危化溶液处理等5个典型操作过程，然后在操作规划程序块内部编制机械臂典型操作子程序块；

3）利用操作规划程序块设置每个过程的移动规则，运算移动路径、移动方向以及移动速度，然后结合总控制台发送的危化溶液提取参数一同修改机械臂操作程序块，使之适用不同的危化溶液提取要求；

4）对工作命令进行解析，利用操作规划程序块根据一定的规则将不同的工作命令与对应修改后的操作程序块绑定，构成工作命令与操作程序块的一一映射。

另外，移动小车移动回路描述为，移动小车开始从起始点A出发，磁带导航经中间点B到指定废点C，完成危化溶液定量提取和危化溶液存储后，移动小车导航移动到检测台D，人工进行危化溶液检测后，运输多余危化溶液到危化溶液处理槽点E，最后移动小车回到起始点A。

图21为本发明的危化溶液自动定位和定量提取过程。移动小车按图20所述步骤规划的路径从起始点A移动到指定危化溶液点C，之后发送控制信号给多关节机械臂系统，命令其开始准备工作。首先多关节机械臂系统末端的多功能夹具装置中的定量取液装置转动到工作位；接着多关节机械臂抬高至安全高度，在视觉超声波检测系统中的视觉模块引导下运动到指定危化溶液池里面，确定出平面位置，同时视觉超声波检测系统中的超声波模块开始工作，检测出危化溶液液面与取量装置之间的距离，确定出高度位置；然后多关节机械臂PLC控制器根据检测到的平面位置和高度位置确定出定量取液装置空间位置坐标，并控制定量取液装置按一定速度深入危化溶液面以下一定距离，进行第一次危化溶液定量吸取，待吸取量达到设定值后，将危化溶液转移到存储装置的取液量杯中；然后根据先前接收到的取液指令和路径规划，移动小车转移到下一个危化溶液点，进行第二次危化溶液定量吸取，与此类推，直到完成所有指定危化溶液点的定量取液操作。

具体的，多关节机械臂PLC控制器的IO口可直接发出控制信号，驱动气动系统中的真空发生器组件，控制气动系统的准确吸气和放气，那么定量取液装置每次取液时利用这种原理实现液体精确吸取与排出。

定量取液装置中的取液容器本体分为上、下容器室，上容器室为气体室，下容器室为液体室。首先气动系统开始吸气，使气体室充满工作气体，同时将定量取液装置中的移动活塞缓慢推至最底部，排空液体室。多关节机械臂PLC控制器控制机械臂缓慢向下运动，使定量取液装置深入危化溶液面以下一定距离，气动系统开始排气，使定量取液装置中的活塞缓慢向上移动，同时定量取液装置上的传感器不断检测抽取的危化溶液量，待检测的危化溶液量与设定值相等时，气动系统停止排气，危化溶液提取操作完成。然后多关节机械臂PLC控制器发送取液完成信号给危化溶液存储装置，危化溶液存储装置及时检测危化溶液存储情况，控制气动系统打开密封顶盖，做好存储危化溶液准备。多关节机械臂PLC控制器根据危化溶液存储信息选择新的取液量杯，然后在气动系统的作用下将危化溶液注入选择的取液量杯。最后关闭危化溶液存储装置密封顶盖，防止危化溶液转运过程中散落，至此完成危化溶液存储操作。与此同时，多关节机械臂各个关节回到零点位置，准备接受指令进行下一次动作。

图22为本发明的危化溶液运输和定点放液流程。移动小车按图20所述步骤规划的路径从危化溶液点移动到指定检测点。运输过程中，危化溶液存储装置保持封闭，直到到达指定位置。然后进行定点放液操作，首先移动小车PLC控制器控制危化溶液存储装置的气动密封顶盖打开，再发送放液指令给多关节机械臂系统，多关节机械臂系统接受放液指令后移动至危化溶液存储装置上方，其PLC控制器控制多功能夹具装置的夹具本体转动180度，换成气动三爪卡盘装置，再将存储危化溶液的取液量杯从危化溶液存储装置中夹取出至一定高度，在视觉超声波系统的引导下找到指定放液点和放液高度，最后调用事先编制好的检测台定点放液程序块将取液量杯放置在指定检测台。如此重复，直到提取的危化溶液全部放置在检测台指定位置。定点放液操作完成以后，移动机械人系统停止动作，等待下一步动作指令。

图23为本发明的多余危化溶液自动处理流程。人工进行危化溶液检测后，多余危化溶液连同取液量杯放回原检测台放液点，按下放液点旁边的与总控制台连接的检测完成按钮，那么总控制台发送多余危化溶液处理指令给移动机器人系统，命令其将多余危化溶液转移到危化溶液处理槽点进行处理。总控制台上的检测完成按钮通过OI扩展卡与主控计算机相连，其信号信息输入主控计算机上的监控应用系统，经处理后通过监控应用系统的取液信息输入和指令发送模块将多余危化溶液处理指令发送给移动小车系统。

移动机器人系统接收多余危化溶液处理指令，用多关节机械臂系统中的气动三爪卡盘装置将取液量杯夹回危化溶液存储装置并密封，再按照图20规划的路径移动到危化溶液处理槽点，在视觉超声波系统的引导下找到危化溶液处理槽放液位置，调用事先编制好的多余危化溶液处理程序块执行多余危化溶液处理工作。完成多余危化溶液处理工作后，按照图20规划的路径移动到起始点，等待总控制发出下一步动作指令。至此完成第一轮危化溶液提取及处理任务。

完成第一轮危化溶液提取及处理任务后，移动机器人系统查询是否有新的任务，没有则停止动作结束工作，并反馈给总控制台任务完成的信号；有则开始准备第二轮取液任务，如此重复，直到完成所有取液任务。

对于具体实施方式的理解的描述仅仅是为帮助理解本发明，而不是用来限制本发明的。本领域技术人员均可以利用本发明的思想进行一些改动和变化，只要其技术手段没有脱离本发明的思想和要点，仍然在本发明的保护范围之内。

Claims (8)

1.一种基于移动机器人的危化溶液自动定位以及定量提取的方法，所述移动机器人包括移动小车系统、多关节机械臂系统、夹具系统、视觉超声波检测系统及危化溶液存储系统；所述移动机器人与总控制台系统通讯连接；其特征在于所述方法包括：

a）移动小车系统按照规划路径从起点移动至指定危化溶液点，然后发送取液指令给多关节机械臂系统；

b）多关节机械臂系统在视觉超声波检测系统的引导下，控制夹具系统进行危化溶液定量取液操作；

d）完成危化溶液定量取液操作后，将危化溶液转移至危化溶液存储系统；

e）根据取液指令和规划路径完成其他危化溶液点的危化溶液采集；

f）关闭危化溶液存储系统；

g）多关节机械臂系统各关节回到零点位置；

移动小车系统和多关节机械臂系统均内置有PLC控制器；移动小车系统PLC控制器与多关节机械臂系统PLC控制器为主从控制模式；

移动小车系统的移动路径规划包括：

在移动小车PLC控制器内部编制路径规划程序块，所述路径规划程序块根据总控制台系统发送的关键位置点信息运算包括移动回路、运动方向、以及移动速度的运动参数；

利用路径规划程序块根据高危环境下设置的空间坐标运算移动小车系统关键位置点的设计位置信息，作为导航传感器和地标传感器检测到的实际位置信息的比对参考点；

利用路径规划程序块在关键位置点之间导航路径两边规划1个辅助位置点，并运算出包括局部辅助移动回路、运动方向、以及移动速度的运动参数，当导航路径被阻碍时，移动小车可选用辅助回路绕开障碍继续移动；

在路径规划程序块内部添加移动小车系统导航数据处理子程序块，该子程序块被用于处理磁导航传感器和磁地标传感器检测到的数据，确保移动小车系统沿着导航磁条或辅助移动回路移动；

利用路径规划程序块规划出位置与信号映射，即移动小车移动到不同关键位置点给多关节机械臂PLC控制器发送的工作指令和危化溶液提取参数，给总控制台系统反馈的实际位置信息和设备运行状况，其中工作指令包括危化溶液定量提取、危化溶液放回存储装置、检测台定点放液、多余危化溶液自动夹取、多余危化溶液倾倒多关节机械臂操作工作指令。

2.根据权利要求1所述的一种基于移动机器人的危化溶液自动定位以及定量提取的方法，其特征在于：所述夹具系统包括夹具本体、转动装置、定量取液装置以及气动三爪卡盘装置。

3.根据权利要求1所述的一种基于移动机器人的危化溶液自动定位以及定量提取的方法，其特征在于：所述b）步骤即多关节机械臂系统的PLC控制器控制夹具系统的夹具本体转动，定量取液装置转动至工作位；多关节机械臂抬高至安全高度，在视觉超声波检测系统中的视觉模块的引导下运动到指定危化溶液池里面，确定出平面位置，同时视觉超声波检测系统中的超声波模块开始工作，检测出危化溶液液面与取量装置之间的距离，确定出高度位置；多关节机械臂PLC控制器根据检测到的平面位置和高度位置确定出定量取液装置空间位置坐标，并控制定量取液装置深入危化溶液面以下，进行危化溶液定量吸取。

4.根据权利要求2所述的一种基于移动机器人的危化溶液自动定位以及定量提取的方法，其特征在于：所述定量取液装置包括取液容器本体、检测传感装置及定量取液气动装置；所述取液容器本体通过检测传感装置与多关节机械臂PLC控制器相连；所述取液容器本体外部设置有气动连接口；所述定量取液气动装置通过气动连接口与取液容器本体相连；所述检测传感装置设置在取液容器本体外部；所述取液容器本体内部被移动活塞从上至下依次分为气体室和液体室。

5.根据权利要求4所述的一种基于移动机器人的危化溶液自动定位以及定量提取的方法，其特征在于：所述定量取液操作包括：定量取液气动装置吸气，气体室充满空气，排空液体室；多关节机械臂系统的PLC控制器控制机械臂缓慢向下运动，使定量取液装置深入危化溶液面以下一定距离，气动系统开始排气；检测传感装置检测抽取的危化溶液量，待检测的危化溶液量与设定值相等时，气动装置停止排气，危化溶液提取操作完成。

6.根据权利要求1所述的一种基于移动机器人的危化溶液自动定位以及定量提取的方法，其特征在于：所述危化溶液存储系统包括存储本体、取液量杯、重量传感器以及气动装置；所述取液量杯置于存储本体中；所述重量传感器置于取液量杯底部；所述气动装置一端与移动小车系统PLC控制器相连，另一端与存储本体相连；所述重量传感器与移动小车系统PLC控制器相连。

7.根据权利要求6所述的一种基于移动机器人的危化溶液自动定位以及定量提取的方法，其特征在于：所述d）步骤即：多关节机械臂系统中的PLC控制器发送取液完成信号给危化溶液存储系统，移动小车系统PLC控制器通过重量传感器检测危化溶液存储情况，控制气动系统打开危化溶液存储系统的密封顶盖，做好存储危化溶液准备；多关节机械臂系统中的PLC控制器根据危化溶液存储信息选择新的取液量杯，然后在气动装置的作用下将危化溶液注入选择的取液量杯。

8.根据权利要求1所述的一种基于移动机器人的危化溶液自动定位以及定量提取的方法，其特征在于：步骤f）即移动小车系统PLC控制器通过重量传感器检测危化溶液存储情况，控制气动系统关闭危化溶液存储系统的密封顶盖。

Images