一种破拆机器人手眼协调定位装置及方法

一种破拆机器人手眼协调定位装置及方法
【技术领域】
[0001] 本发明涉及机器人定位技术，具体是一种破拆机器人手眼协调定位装置及方法。
【背景技术】
[0002] 在面临地震、泥石流等灾害时，需要紧急进行救援来尽量降低人员及财产损失，因 此提高震后的应急救援能力极其重要，用于灾害现场的安全应急救灾设备也是"十二五"时 期中国机械工业的发展重点之一。
[0003] 日本的东芝、三菱公司等相继开展了用于危险现场搬运作业的机器人，如东芝公 司研发的Smart-M机器人可以搬运5kg左右的重物，三菱公司研制的Swan机器人具有地形 适应能力，并可以搬运IOkg左右的中等载荷。但是这些破拆机器人一般均采用遥控器人 工手工操作方式进行破拆作业，而在现场复杂和危险的环境下，对操作员人身安全带来很 大威胁。针对文献"破拆救援机器人关键技术"（刘庆运.《现代制造工程》，2009,30(7)， pp. 149~153.)中提出未来破拆机器人具备的功能有智能破拆作业，实时运动规划，传感 与目标识别等关键技术，本发明提出的装置及方法能解决传统的破拆机器人存在的作业目 标定位及机械臂自主运动功能，填补破拆机器人智能破拆作业功能应用的空白。

【发明内容】

[0004] 本发明的目的在于提供一种破拆机器人手眼协调定位装置及方法，解决了破拆机 器人作业目标定位问题。
[0005] 为实现上述目的，本发明提供如下技术方案：
[0006] -种破拆机器人手眼协调定位装置，由多关节液压驱动机械臂、激光测距传感器、 CAN总线控制器、车载电脑构成；所述激光测距传感器安装在多关节液压驱动机械臂的末 端执行器上，所述激光测距传感器通过CAN总线控制器与车载电脑实现信息交互。
[0007] 作为本发明进一步的方案：所述激光测距传感器采用的是SICK LMS151激光测距 传感器。
[0008] 作为本发明进一步的方案：所述CAN总线控制器采用的是PEAK-USB CAN总线控制 器。
[0009] 作为本发明进一步的方案：所述车载电脑采用的是TREK-753车载电脑。
[0010] -种利用所述的破拆机器人手眼协调定位装置进行定位的方法，包括以下步骤：
[0011] 1)激光测距传感器将采集的距离信息通过CAN总线发送到车载电脑；
[0012] 2)车载电脑对接收到的距离信息进行处理后，再通过CAN总线发送液压元件的速 度驱动信号来驱使多关节液压驱动机械臂运动到指定目标位置，完成机械臂自动定位和运 动控制。
[0013] 作为本发明进一步的方案：所述步骤2)中，车载电脑通过调用机械臂自动运动控 制算法对接收到的距离信息进行处理，具体包括以下步骤：
[0014] 21)将末端执行器上的激光测距传感器激光红点对准欲破拆的作业点；
[0015] 22)将获得的激光距离值通过齐次变换矩阵转为末端执行器下坐标；
[0016] 23)通过连杆变换矩阵将末端执行器下坐标转为基坐标系下坐标；
[0017] 24)根据逆运动学方程求出的各关节角角度；
[0018] 25)通过对液压执行部件发送速度信号驱动机械臂运动。
[0019] 作为本发明进一步的方案：安装在多关节液压驱动机械臂的末端执行器上的激光 测距传感器的激光发射方法与末端执行器某一坐标轴方向一致。
[0020] 与现有技术相比，本发明的有益效果是：
[0021 ] 1、开发一种破拆机器人手眼目标定位装置，可以有效满足机器人在恶劣环境下进 行精确作业定位的需要。
[0022] 2、设计依附于手眼目标定位装置的破拆机器人液压器件驱动多关节机械臂自主 运动控制算法解决了现有遥控器手工操作的动作迟缓及作业点找不准问题。
【附图说明】
[0023] 图1是本发明定位装置的结构示意图；
[0024] 图2是实施例的示意图；
[0025] 图3为破拆机器人多关节机械臂连杆坐标系布局图；
[0026] 图4是本发明定位方法的流程图；
[0027] 图5为机械臂自动运动控制算法的流程图；
[0028] 图中：1-多关节液压驱动机械臂、2-激光测距传感器、3-CAN总线控制器、4-车载 电脑。
【具体实施方式】
[0029] 下面将结合本发明实施例，对本发明实施例中的技术方案进行清楚、完整地描述， 显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的 实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都 属于本发明保护的范围。
[0030] 请参阅图1~2,本发明实施例中，一种破拆机器人手眼协调定位装置，由多关节 液压驱动机械臂1、激光测距传感器2、CAN总线控制器3、车载电脑4构成；激光测距传感 器2安装在多关节液压驱动机械臂1的末端执行器上，其激光发射方法与末端执行器某一 坐标轴方向一致，激光测距传感器2将采集的距离信息通过CAN总线发送到车载电脑，由车 载电脑进一步调用机械臂自主运动控制算法进行下一步处理，最后由车载电脑4通过CAN 总线发送液压元件的速度驱动信号来驱使多关节液压驱动机械臂1运动到指定目标位置， 完成机械臂自动定位和运动控制。定位装置的控制原理如下：通过破拆机器人自带云台摄 像机，观察到现场的画面，通过远端控制器控制末端执行器对准破拆目标，激光测距传感器 2获得破拆目标的距离并通过CAN总线传回车载电脑4,车载电脑4将激光距离信息、机械 臂当前姿态、液压缸有效运动范围等数据代入机械臂自主运动控制算法，驱动机械臂进行 运动。
[0031] 多关节液压驱动机械臂1采用的是5关节液压驱动机械臂，激光测距传感器2采 用的是SICK LMS151激光测距传感器，CAN总线控制器3采用的是PEAK-USB CAN总线控制 器，车载电脑4采用的是TREK-753车载电脑。
[0032] 请参阅图4, 一种利用所述的破拆机器人手眼协调定位装置进行定位的方法，包括 以下步骤：
[0033] 1)激光测距传感器（2)将采集的距离信息通过CAN总线发送到车载电脑（4);
[0034] 2)车载电脑（4)对接收到的距离信息进行处理后，再通过CAN总线发送液压元件 的速度驱动信号来驱使多关节液压驱动机械臂（1)运动到指定目标位置，完成机械臂自动 定位和运动控制。
[0035] 上述步骤2)中，车载电脑（4)通过调用机械臂自动运动控制算法对接收到的距离 信息进行处理，具体包括以下步骤：
[0036] 21)将末端执行器上的激光测距传感器（2)激光红点对准欲破拆的作业点；
[0037] 22)将获得的激光距离值通过齐次变换矩阵转为末端执行器下坐标；
[0038] 23)通过连杆变换矩阵将末端执行器下坐标转为基坐标系下坐标；
[0039] 24)根据逆运动学方程求出的各关节角角度；
[0040] 25)通过对液压执行部件发送速度信号驱动机械臂运动。
[0041] 请参阅图3和5,机械臂自主运动控制算法，步骤为：
[0042] 算法步骤为：
[0043] 1、根据定位装置测出的激光测距传感器2在末端执行器安装位置之间的转换矩 阵将作业目标距离转为末端执行器坐标系下三维坐标。激光测距传感器2安装在末端执行 器坐标系的Y轴原点，激光器发射方向与Y轴正向一致，当前激光测距传感器2的读数是d 米，则作业目标在第五坐标系（关节5坐标系，即末端执行器坐标系）下的坐标表示则为 [0, d，0]〇
[0044] 2、通过基坐标系与末端执行器坐标系之间的齐次转换矩阵计算获取激光测距系 统下的目标物体坐标。末端执行器坐标系（关节5坐标系）相对基坐标系（关节1坐标
系）的齐次变换矩阵为 其中rn= cos Θ 5*(c〇s Θ 4*(c〇s Θ ,cos Θ 2*c〇 9 s Θ 3-cos Θ lf 木sin θ 2木sin θ 3) -sin Θ 4木(cos Θ i-cos θ 2木sin Θ 3+cos Θ i-cos Θ 3>!<sin θ 2))_s in θ 5*(cos θ 4*(cos θ ,cos θ 2*sin θ 3+cos θ ,cos θ 3*sin θ 2)+sin θ 4*(cos θ ,cos θ 2>!<co s θ 3-cos θ 々in θ 2*sin θ 3));
[0045] r12=-cos θ 5* (cos θ 4* (cos θ ^cos θ 2*sin θ 3+cos θ ^cos θ 3*sin θ 2)+sin θ 4>!<(c os θ i-cos θ 2木cos θ 3_cos θ i-sin θ 2木sin θ 3))_sin θ 5木(cos θ 4>!<(cos θ i-cos θ 2木cos θ 3_co s θ i氺sin θ 2氺sin θ 3)_sin θ 4^(cos θ i^cos θ 2氺sin θ 3+cos θ i^cos θ 3氺sin θ 2));
[0046] r13= -sin θ 1;
[0047] r21= cos θ 5* (cos θ 4* (cos θ 2*cos θ 3*sin θ「sin θ 々in θ 2*sin θ 3)-sin θ 4* (c os θ 2氺sin θ θ 3+cos θ 3氺sin θ θ 2))_sin θ 5氺(cos θ 4^(cos θ 2氺sin θ θ 3+co s θ 3氺sin θ θ 2)+sin θ 4^(cos θ 2^cos θ 3氺sin θ i-sin θ θ 2氺sin θ 3));
[0048] r22=-cos θ 5* (cos θ 4* (cos θ 2*sin θ ^sin θ 3+cos θ 3*sin θ ,sin θ 2)+sin θ 4>!<(c os θ 2^cos θ 3氺sin θ i-sin θ θ 2氺sin θ 3))_sin θ 5氺(cos θ 4^(cos θ 2^cos θ 3氺si