排爆机器人控制与无线通讯系统

排爆机器人属于搬运机器人的一种类型，很多搬运机器人是模仿人类的动作，用来帮助或部分代替人来进行繁重、危险、重复等工作。排爆机器人模仿人类的行走、抓取物体的动作，可以被用来排除现场的爆炸物。排爆机器人机械部分包含行走小车和机械手臂。

1 排爆机器人控制系统结构

排爆机器人控制系统不再采用原来机器人所采用的PLC控制方式，而是基于嵌入式工控机的基础上，采用基于Linux平台的开放式构件库，运算速度极快，可以达到微秒级。排爆机器人控制系统由三部分组成，即传感器部分、机器人本体、操作控制台组成。传感器部分包含宽接入、多信息融合器。宽接入、多信息融合基于ARM9系统，由12位精度以上A/D、32路I/O、RS232通讯接口组成，能融合多种传感器信号;机器人本体包含嵌入式控制计算机和各关节伺服电机，能驱动各轴（带补偿），分配各轴运动，处理和控制各种状态量;操作控制台部分包含主控PC机、指令解码器、图像解码器、无线接收发射器等。CCD摄像机和超声波传感器所获得的图像信息、障碍物信息，经无线传输至主控PC机。主控PC机使用图像识别和分析技术获得对象物体的形状和位置信息，同时将目标物、障碍物等三维图像信息显示在计算机屏幕上。在人工指明目标物后，主控PC机经人工智能（模式识别、路径规划、轨迹避碰等）计算;将控制指令通过无线传输给机器人本体嵌入式控制计算机，自动控制机器人运动。基本结构如图1所示：


图1排爆机器人控制系统基本结构

2 小车的行走控制

人工通过控制杆（或按钮），在小车引导图像（可视信号）的指示下，完成前进、后退、左转、右转和原地旋转的功能直至达到机械手的手爪能抓取可疑爆炸物的位置为止。机器人的平衡是利用整机的动力学算法求得，将求得多种数据去控制机器人手臂的空间姿态从而达到整机平衡而不至于倒覆。例如当小车在斜坡作上升运动时，机器人手臂往前靠以保持整机的平衡。小车在运动过程中需要避开可能遇到的障碍物。通过环境传感器如CCD摄像、超声波传感器等取得障碍物大小及环境信息，实现小车避障，即所谓的路径规划（如图2所示）



图2 排爆机器人路径规划示意图

3 机械手的运动控制

机械手的运动控制（如图3）是多级控制系统：位于最上层的AI级是人工智能层。它是利用CCD摄像机和超声波等传感器获得障碍物轮廓与距离以避开障碍物实现避碰，这就是“轨迹规划”（如图4）。



图3 机械手多级运动控制系统



图4 机械手轨迹规划示意图

位于中间层的控制是机械手抓取运动控制中最关键的部分。它实际上是一个补间器。机械手的运动控制可分为姿态控制与手位置控制。腰、大臂、小臂、手爪的控制，是由主控计算机通过机械手运动学位移问题进行反向运动求解，得出腰、大臂、小臂、手爪的位置，然后给出各关节位置指令传至上述关节的嵌入式系统控制计算机，完成带有速度反馈环的位置控制。四个关节的运动速度通过机械手的轨迹规划来决定，从而避免机械手的蛇形运动。由于有触觉传感器，手爪可以自动控制，也可以是在图像信号的指引下作精细“柔软控制”。抓取可疑爆炸物时，控制手爪夹持力约大于可疑爆炸物脱落重力，不至用力过大而夹坏可疑爆炸物，从而完成专家指定的动作。

位于最下层是控制级位置控制器与速度调节器均采用成熟的PID（包括P、PI、PD）控制。当PID控制其选择合适的参数时，具有一定鲁棒性，简单、实用。当PID无法实现有效控制时，可改进之或结合其它方法，如前馈控制。运动控制包括机械手各个关节运动控制和行走运动，初步统计控制回路有13路，如图 5所示。



图5 自动控制原理图

嵌入式控制计算机根据上位计算机传来的位置与速度信号，对各个伺服机构进行位置与速度设定，按控制规律（如PID）对伺服电机进行控制，使实际位置按预计的速度跟踪或运动到目标位置。

机器人的手眼协调系统：机器人的手眼协调系统是本系统最大亮点之一。由于于补间器算法需要知道目标物与机器人基坐标（一般是机械人的腰关节底座），相对空间座标才能求解。而本系统目标物是在未知环境里。这相对坐标必须由于手眼协调系统来求解。排爆机器人机械手上装有双目系统，利用双目系统和目标物可构成“ 测矩三角型”，原理示意如图6。测矩三角型求得距离误差较大，需要利用激光测距的“光斑”辅助测矩，从而获得坐标物的空间座标。随着机器人的双目接近目标物，目标物与基坐标的相对坐标精度提高，经过数次双目逼近目标物之后，最终实现机械手准确地抓到目标物。



图6 测矩三角型原理图

当机器人自动抓取失败之后，操纵者可利用手动系统完成抓取。这是任何一个产品在自动失灵之后必须具备的功能。机器人的双目获得的图像信息，通过处理，在控制台的显示器上形成监控图像，以便操控者以鼠标点取多个物体中的可疑物体。