一种机器人的人-机交互安全防护系统的制作方法
【技术领域】
[0001] 本发明属于机器人及人机交互技术领域，涉及一种机器人的人-机交互安全防护 系统。
【背景技术】
[0002] 在现代工业生产领域，一些工作往往需要机器人和人交互操作才能完成。这一过 程中，人手和机械人末端执行器的抵近接触非常频繁，人的安全自然成为关注的焦点。因 此，如何消除人和机器人之间的非正常接触碰撞已成为首要的安全理念。关于人-机交互 操作的安全性，目前没有统一的处理方法。
[0003] 现有的基于危险指数进行路径及轨迹规划的事前控制方法，虽然有较完善的理论 设计。但需要大量的人-机交互信息支撑，实时性要求高，工程实用性不强。
[0004] 有人提出关节柔顺设计的方法，它通过降低电机转子惯量到连杆的耦合性来提高 安全性。但是连杆本身的惯量和能量却无法控制，同时在人-机碰撞时或后续时间，机器人 仍为位置控制模式，人-机之间的碰撞力不可控。因此，关节柔顺设计不能从根本上解决安 全性问题。
[0005] 还有人提出在机器人末端执行器包裹黏弹性材料的方法来提高安全性，该法可在 一定程度上降低冲击力和伤害程度，但该法过于单一，无法从根本上保证安全。
[0006] 上述所有方法方式较为单一，没有融合其他有效方法，不能彻底解决安全性问题。 且多数目前还仅仅停留在理论研究阶段，其实用性和前景也未知。
【发明内容】
[0007] 有鉴于此，本发明的目的在于提供一种机器人的人-机交互安全防护系统，该安 全防护系统能够有效确保人-机交互操作时的安全性。
[0008] 为达到上述目的，本发明提供如下技术方案：
[0009] -种机器人的人-机交互安全防护系统，所述安全防护系统由处于人-机交互环 境中的语音提示装置1、安装于机器人摆臂末端执行器上的融合型传感器I、覆盖在机器人 摆臂末端执行器上的灵敏皮肤4以及信号传递线路组成。
[0010] 所述融合型传感器I由六维力传感器2和视觉传感器3组成；所述视觉传感器3 用于对人脸、人手和目标物进行发现和识别；所述六维力传感器2用于测量三维直角坐标 系中三个力分量和三个力矩分量，通过力信息帮助机器人调整交互操作时的接触力；所述 灵敏皮肤4采用主动红外接近传感器，并以环状的形式覆盖在末端执行器上；所述语音提 示装置1用于语音播报当前的状态、操作情况及是否出现错误，同时也可方便更改语音提 示器的提示词。
[0011] 进一步，所述六维力传感器2和视觉传感器3之间采用融合反馈控制算法，所述 融合控制算法分为视觉和力觉两路控制信号，为机器人系统提供力和视觉方面的综合性信 息。
[0012] 进一步，所述视觉传感器3采用传感摄像头。
[0013] 进一步，所述语音提示装置1还可以采用声光报警提示器。
[0014] 本发明的有益效果在于：本发明所述的安全防护系统基于多传感器系统，并依托 融合型反馈控制算法，将视觉、力觉、肤觉传感器全面而充分应用到人-机交互操作的全过 程中，全面、彻底地保证人-机交互操作时人的安全性；语音提示系统也使操作人员的操作 更加便捷，有效提升人-机之间的安全系数；同时可根据不同的使用环境对该系统进行修 改设置，工程实用性强。
【附图说明】
[0015] 为了使本发明的目的、技术方案和有益效果更加清楚，本发明提供如下附图进行 说明：
[0016] 图1为本发明所述系统的结构示意图；
[0017] 图2为图1中融合型传感器I的局部放大图；
[0018] 图3为人-机交互安全距离示意图；
[0019] 图4为传感器系统控制算法框图；
[0020] 图5为对应于相关事件和状态的提不首不意图。
【具体实施方式】
[0021] 下面将结合附图，对本发明的优选实施例进行详细的描述。
[0022] 图1为本发明所述系统的结构示意图，图2为图1中融合型传感器I的局部放大 图，如图所示，所述安全防护系统由处于人-机交互环境中的语音提示装置1、安装于机器 人摆臂末端执行器上的融合型传感器I、覆盖在机器人摆臂末端执行器上的灵敏皮肤4以 及信号传递线路组成。
[0023] 所述融合型传感器I由六维力传感器2和视觉传感器3组成；所述视觉传感器3 用于对人脸、人手和目标物进行发现和识别；所述六维力传感器2用于测量三维直角坐标 系中三个力分量和三个力矩分量，通过力信息帮助机器人调整交互操作时的接触力；所述 灵敏皮肤4采用主动红外接近传感器，并以环状的形式覆盖在末端执行器上；所述语音提 示装置1用于语音播报当前的状态、操作情况及是否出现错误，同时也可方便更改语音提 示器的提示词。在本实施例中，视觉传感器3采用传感摄像头；进一步，所述语音提示装置 1还可以采用声光报警提示器。
[0024] 为了便于理解，在本实施例中对人-机交互环境中几个坐标系作简要描述，包括 大地坐标系、机器人末端执行器坐标系、六维力传感器坐标系和视觉传感器坐标系。所述大 地坐标系的定义如图3所示，X轴水平向左，y轴竖直向上，z轴垂直纸面向外。在人-机交 互操作时，人脸沿z向面对机器人，人手携带目标物亦沿z向接近机器人末端执行器。所述 其余坐标系为局部坐标系，其中机器人末端执行器坐标系各坐标轴方向由安装位置设定， 六维力传感器坐标系和视觉传感器坐标系各坐标轴方向由初始设计而定。
[0025] 如图3所示，在人-机交互环境中需要确定人的安全作业范围。其中人手距人脸 沿z向的安全距离要大于dl，人脸距机器人末端执行器沿z向的距离处于d2_~d2 _之 间。dl、d2min、d2max的具体值可根据机器人型号和操作类型确定。本实施例中dl = 90mm， d2min= 160mm，d2max= 2500mm。
[0026] 在人-机交互过程中，要经历人出现、人靠近、人手中目标物接近机器人末端执行 器、末端执行器夹紧目标物、离开等不同状态。对应地，在经历上述状态时，融合型传感器可 以将采集到的视觉信息、力/力矩信息和肤觉信息可以及时准确传送给机器人系统，以便 机器人做出准确的轨迹规划动作，避免伤及到人。先是视觉传感器识别人脸及目标物，并完 成信息传送。而后是夹持过程中力传感器的六维力信息传送。每一状态都由不同传感器起 主导作用，但不同状态时各传感器均同台协作工作，发挥信息融合效应。所述视觉和力觉传 感器保证人员安全的工作原理如下：
[0027] 所述视觉传感器保证人员安全的工作原理如图1、图3所示，在人及目标物靠近 机器人过程中，依据一定的视觉识别算法，视觉传感器可以识别出如图1所示Θ角范围内 (本实施例取70° )的人脸、人手及目标物。同样，当机器人系统能够探测到人脸时，机器 人的运动情况也在人的视野范围之内。机器人有了视觉识别功能，就可以判断出人是否能 够跟随机器人的动作并做好应对措施，这具有积极意义。当视觉信息中出现如下情况时，出 于保护人员安全起见，视觉识别算法会自动取消机器人所执行任务：1)机器人系统不能探 测到人脸；2)人手距人脸沿z向的距离小于安全距离dl = 90mm ;3)操作人员手中没有目 标物。
[0028] 所述力传感器保证人员安全的工作原理为：在人手及手中目标物靠近机器人末端 执行器的过程中，视觉传感器会辨别人手及手中目标物并展开视觉追踪。当目标物接近机 器人末端执行器时，系统根据视觉传感器提供的目标物位姿信息判断出能否抓取目标物并 计算出合理的抓取位置。抓取目标物时，六维力传感器会及时反馈夹紧力的大小和方向。融