[发明专利]一种无传感器的机器人碰撞检测保护装置及方法

说明书

技术领域

本发明涉及一种防撞保护装置及方法，尤指一种无传感器的机器人碰撞检测保护装置及方法。

背景技术

一般地，机器人被广泛运用于电子产品中，如汽车工业、塑料工业、药品工业及食品工业等领域，用于完成搬取、装配、喷涂、焊接等操作，以代替人工操作，从而提高生产效率。

如，一种真空机器人，用于在一特殊洁净环境下对硅片加工，其主要功能是实现硅片在不同工位之间快速、高效、可靠的转移。然而，所述真空机器人的安全问题一直是应用中的一个非常重要的问题。当机器人与人或其它设备协同工作时，不小心发生碰撞会对机器人本体或者周围设备(尤其是人)造成很大的伤害，尤其在真空机器人工作中，碰撞还会造成晶圆的损坏并且造成真空室的污染。如何在机器人工作中能够及时检测到其他设备或者工作人员与机器人将要发生碰撞，并采取有效措施是需要解决的关键问题。现有的机器人防碰撞的方法，是采用在机器人本体上安装距离传感器，并同时配有距离计算模块，通过计算模块计算出的机器人与周围物体的距离来避免机器人发生碰撞。然而，上述方法适用于服务机器人这样的移动机器人中，且需要在机器人正面安装距离传感器并且所述服务机器人始终朝着正面方向运动即可，而真空机器人的机械手无法安装这种传感器，而且真空机械手的运动方向有前有后，若四个方向同时用距离传感器则成本太大。

发明内容

鉴于以上内容，有必要提供一种成本小，又能及时采取保护措施的无传感器的机器人碰撞检测保护装置及方法。

一种无传感器的机器人碰撞检测保护方法，包括有一机器人，所述机器人包括有一规划的状态，所述方法包括以下步骤：所述机器人内的一参数设置模组设置机器人防护保护装置的参数，所述参数包括有一预设阈值；所述机器人内的一观测模组实时监测所述机器人工作时受到的扰动力，计算出未知扰动，并估计出所述机器人在下一时刻的运动状态；所述机器人内的一计算模组根据所述观测模组计算的结果计算出机器人下一时刻的运动状态与机器人规划的状态之间的差值；所述机器人内的一判断模组判断所述机器人在下一时刻的运动状态与机器人规划的状态之间的差值是否大于所述预设阈值；所述机器人内的一执行模组在所述判断模组判断出所述机器人在下一时刻的运动状态与机器人规划的状态之间的差值大于所述预设阈值时，驱使所述机器人停止工作。

在一实施方式中，所述观测模组为一Luenberger扰动观测器。

在一实施方式中，所述Luenberger扰动观测器为一高增益K-滤波器的观测器。

在一实施方式中，所述机器人内的一优化模组对所述Luenberger扰动观测器训练，使所述Luenberger扰动观测器计算出的各参数的权值得到优化。

在一实施方式中，所述优化模组为一神经元网络，所述神经元网络采用三层网络、误差后向反馈的BP算法。

在一实施方式中，所述三层网络包括一输入层、一隐藏层及一输出层。

一种无传感器的机器人碰撞检测保护装置，包括有一机器人，所述机器人包括有一规划的状态，所述机器人包括：一参数设置模组，用于设置机器人防护保护装置的参数，所述参数包括有一预设阈值；一观测模组，用于实时监测所述机器人工作时受到的扰动力，计算出未知扰动，并估计出所述机器人下一时刻的运动状态；一计算模组，用于根据所述观测模组计算的结果计算出机器人下一时刻的运动状态与机器人规划的状态之间的差值；一判断模组，用于判断所述机器人在下一时刻的运动状态与机器人规划的状态之间的差值是否大于所述预设阈值；一执行模组，用于在所述判断模组判断出所述机器人在下一时刻的运动状态与机器人规划的状态之间的差值大于所述预设阈值时，驱使所述机器人停止工作。

在一实施方式中，所述观测模组为一Luenberger扰动观测器。

在一实施方式中，所述Luenberger扰动观测器为一高增益K-滤波器的观测器。

在一实施方式中，所述机器人包括有一优化模组，所述优化模组用于对所述Luenberger扰动观测器训练，使所述Luenberger扰动观测器计算出的各参数的权值得到优化。