[发明专利]人机协作机器人安全防护系统及安全防护方法

说明书

本发明提供了一种人机协作机器人安全防护系统及安全防护方法，包括光学运动捕捉相机、主控制器及机器人，光学运动捕捉相机获取机器人的位置及周围障碍物的位置，并发送至光学运动捕捉相机坐标系模块；光学运动捕捉相机坐标系模块根据机器人的位置，计算机器人在光学运动捕捉相机坐标系下的三维坐标，形成第一坐标，以及光学运动捕捉相机坐标系模块根据周围障碍物的位置，计算周围障碍物在光学运动捕捉相机坐标系下的三维坐标，形成第二坐标；光学运动捕捉相机坐标系模块将第一坐标和第二坐标发送至主控制器；主控制器根据第一坐标和第二坐标，计算当前时刻机器人与周围障碍物的最短距离，并根据最短距离，控制机器人的运行速度。

技术领域

本发明涉及智能制造技术领域，特别涉及一种人机协作机器人安全防护系统及安全防护方法。

背景技术

随着科学技术的不断发展，制造业的自动化和智能化生产程度不断提高，越来越多的工厂选择使用机器人来协助生产。在生产过程中，许多时候是人机协作来实现装配、焊接等工序，在人机协作的过程中，机械臂与人碰撞使人受伤的情况时有发生。因此，解决人与机器人在同一工作空间工作的安全问题具有重大意义。目前常用的安全防护方法有在机械臂周围加装栅栏、工人穿防护器具等，但这些方法都不能从根本上解决人机协作的安全问题。

发明内容

本发明的目的在于提供一种人机协作机器人安全防护系统及安全防护方法，以解决现有的人机协作不智能且不可靠的问题。

为解决上述技术问题，本发明提供一种人机协作机器人安全防护系统，所述人机协作机器人安全防护系统包括光学运动捕捉相机、主控制器及机器人，其中：

所述光学运动捕捉相机包括光学运动捕捉相机坐标系模块，所述光学运动捕捉相机获取所述机器人的位置及周围障碍物的位置，并发送至所述光学运动捕捉相机坐标系模块；

所述光学运动捕捉相机坐标系模块根据所述机器人的位置，计算所述机器人在所述光学运动捕捉相机坐标系下的三维坐标，形成第一坐标，以及

所述光学运动捕捉相机坐标系模块根据所述周围障碍物的位置，计算所述周围障碍物在所述光学运动捕捉相机坐标系下的三维坐标，形成第二坐标；

所述光学运动捕捉相机坐标系模块将所述第一坐标和所述第二坐标发送至所述主控制器；

所述主控制器根据所述第一坐标和所述第二坐标，计算当前时刻所述机器人与所述周围障碍物的最短距离，并根据所述最短距离，控制机器人的运行速度。

可选的，在所述的人机协作机器人安全防护系统中，所述光学运动捕捉相机包括红外线摄像机，所述红外线摄影机的帧速率大于100Hz，所述红外线摄影机的分辨率大于640*480，所述红外线摄影机设置USB接口，所述USB接口用于输出预处理图像及灰度图像。

可选的，在所述的人机协作机器人安全防护系统中，所述光学运动捕捉相机的数量为6～24台。

本发明还提供一种基于以上所述的人机协作机器人安全防护系统的人机协作机器人安全防护方法，所述人机协作机器人安全防护方法包括：

将所述光学运动捕捉相机固定并放置于所述机器人及所述周围障碍物所在的场地中；

对所述光学运动捕捉相机进行标定，得到所述光学运动捕捉相机坐标系与世界坐标系之间的坐标变换矩阵；

在所述周围障碍物的表面及所述机器人的表面分别设置若干个光学标记点，根据所述光学标记点获取所述第一坐标和所述第二坐标；

利用所述坐标变换矩阵，将所述第一坐标和所述第二坐标转换为世界坐标系下的坐标。

可选的，在所述的人机协作机器人安全防护方法中，所述人机协作机器人安全防护方法还包括：