增强安全性摘复钩机器人系统及控制方法与流程

本发明涉及工业自动化、机器人安全，尤其涉及一种增强安全性摘复钩机器人系统及控制方法。

背景技术：

1、在工业自动化领域，摘复钩机器人的应用日益广泛，但作业过程中的安全性问题仍然是一个挑战。尤其是在电力中断或紧急情况下，如何确保机器人的安全撤退和持续监控成为一个有待解决的问题,现有的解决方案通常侧重于单一的安全机制，缺乏综合性的应对策略。

2、综上所述，需要一种增强安全性摘复钩机器人系统及控制方法来解决现有技术中所存在的不足之处。

技术实现思路

1、针对现有技术的不足，本发明提供了一种增强安全性摘复钩机器人系统及控制方法，旨在解决上述问题。

2、为实现上述目的，本发明提供如下技术方案：一种增强安全性摘复钩机器人系统，其特征在于，包括摘复钩机器人本体、物理安全机制模块、电子安全系统、软件安全功能模块、应急自供电控制模块、局域网监控模块，

3、摘复钩机器人本体，用于执行具体的摘复钩作业任务；

4、物理安全机制模块，用于机器人紧急停止、机械限位保护、抗冲击防爆；此模块可以确保机器人在物理层面上不受损害；

5、电子安全系统，集成有安全plc、安全继电器以及电子围栏监控功能，用于实时监控和控制机器人的电子信号及操作状态；此系统可以确保在设定的安全边界内进行作业；

6、软件安全功能模块，用于软件故障诊断与自我修复，并具有访问控制与权限管理机制；此模块可以保证软件层面的操作安全；

7、应急自供电控制模块，包括备用电源、光电传感器和上电控制单元，在遭遇断电或紧急情况时能即时启动，接管机器人的控制，并依据光电传感器的检测结果指挥机器人撤退至安全位置；

8、局域网监控模块，用于构建独立的自供电局域网，持续监控机器人的运行状态，实时将机器人状态信息传输给中央控制单元。

9、可选的，所述光电传感器，用于探测周围环境的安全性条件；

10、上电控制单元，根据光电传感器的检测结果，调控机器人的运动行为；此单元可以确保其安全撤离。

11、可选的，所述中央控制单元具体操作步骤为：

12、步骤a：接收局域网监控模块传送的机器人状态信息，根据这些信息判断紧急情况的严重程度；

13、步骤b：根据判断结果采取对应措施，可能包括启动报警系统、通知操作人员或者直接进行远程操控；

14、步骤c：存储机器人的操作历史记录，通过对历史数据的分析和学习，优化机器人的操作。

15、一种述增强安全性摘复钩机器人控制方法，包括以下步骤：

16、步骤s1：系统初始化与自检，系统上电，对加载软件程序和网络配置参数进行初始化设置，并执行自检程序；

17、步骤s2：正常作业模式运行，在物理安全机制模块、电子安全系统和软件安全功能模块的共同保护下，机器人本体执行摘复钩作业任务，局域网监控模块实时采集并传输机器人的状态信息至中央控制单元进行监控和记录；

18、紧急情况响应与撤退，当发生断电或紧急情况时，应急自供电控制模块立即启动备用电源接管系统供电；

19、光电传感器检测周围环境的安全性，上电控制单元根据检测结果指挥机器人迅速撤退至安全位置；

20、同时，局域网监控模块通过自供电局域网持续监控机器人的状态信息，并将紧急情况反馈给中央控制单元进行相应处理；

21、步骤s3：紧急情况解除与恢复作业，当紧急情况解除且电力恢复时，系统自动进行环境安全性评估，确认安全后，系统自动切换回正常作业模式，并重新投入摘复钩作业任务中，中央控制单元更新机器人的状态信息并继续进行实时监控和记录。

22、可选的，所述步骤s2中紧急情况的故障检测算法步骤为：

23、步骤s21：极值检测：基于微分的方法对电机脉冲电压数据进行处理，检测出电压数据中的极值点，包括峰值和谷值；

24、步骤s22：时间推理：基于lstm算法，分析电压与时间之间的关系，推理出当前电机的状态；

25、步骤s23：加速度检测：使用机器人上的加速度传感器，监测机器人前后的加速度变化；应用lstm算法对加速度数据进行分析，检测加速度值的变化情况；

26、步骤s24故障报告：当检测到电机状态异常或加速度骤变时，系统将触发故障报告，将故障信息上报至局域网内，以便及时处理和维修。

27、可选的，所述步骤s21中电压的极值通过以下方式计算：

28、步骤sa1：计算一阶导数：对电机脉冲电压数据进行一阶导数计算，在一阶导数中寻找零交点，设置零交点的集合为z={z1,z2,...,zm}，其中m是零交点的个数；

29、步骤sa2：判断峰位置：对于零交点zi，判断其是峰值还是谷值，根据dv_{zi-1}和dv_{zi+1}的符号进行判断，若dv_{zi-1}<0且dv_{zi+1}>0，则zi是峰值点；若dv_{zi-1}>0且dv_{zi+1}<0，则zi是谷值点；

30、步骤sa3：筛选峰值：对检测到的峰值进行筛选和验证，得到极值电压。

31、可选的，所述步骤s22中时间推理通过以下方式进行：

32、步骤sb1：将得出的极值电压、极值电压的当前时间参数作为输入；

33、步骤sb2：构造电机脉冲电压的时间序列数据模型，其中输入向量 xt 表示为[vt, dt, pt]，分别代表在时间t时电机脉冲的电压值vt、持续时间dt以及峰值大小pt；

34、步骤sb3：利用lstm模型对输入向量进行处理，通过计算输入门it、遗忘门ft、细胞状态ct的更新、输出门ot，以及生成隐藏状态ht，对电机状态的动态预测和故障诊断。

35、可选的，所述输入门的计算公式为： ，其中，σ代表sigmoid激活函数，为权重矩阵，为偏置项，是时间步长的嵌入向量，是上一时间步的隐藏状态，是输入向量。

36、可选的，所述遗忘门ft的计算公式：，其中，σ代表sigmoid激活函数，为权重矩阵，为偏置项，是时间步长的嵌入向量，是上一时间步的隐藏状态，是输入向量。

37、可选的，所述细胞状态的更新：；

38、输出门的计算公式： ；

39、隐藏状态的计算：；

40、其中，σ代表sigmoid激活函数，表示hadamard乘积，为权重矩阵，为偏置项，是时间步长的嵌入向量，是上一时间步的隐藏状态，是候选细胞状态，是输入向量。

41、本发明的有益效果：

42、本发明中，在正常作业状态下，摘复钩机器人本体执行作业任务，同时物理安全机制、电子安全系统和软件安全功能持续监控和保护机器人的安全。

43、本发明中，当发生断电或紧急情况时，应急自供电控制模块立即启动，接管机器人的控制，备用电源为上电控制单元供电，光电传感器检测周围环境的安全性，根据检测结果，上电控制单元控制机器人迅速退回到安全位置。

44、本发明中，通过多层次的安全机制确保机器人在各种作业环境下的安全性；应急自供电控制模块能够在断电或紧急情况下迅速接管机器人控制，确保机器人的安全撤退；局域网监控模块能够持续监控机器人的状态，为中央控制单元提供实时的状态信息，有助于及时应对紧急情况；提高生产效率，减少因安全事故导致的停工和维修时间。