配网带电作业机器人激光剥线工具的控制系统及控制方法与流程

摘要: 本发明涉及机器视觉控制领域,具体为配网带电作业机器人激光剥线工具的控制系统及控制方法。背景技术:1、目前,配网带电作业机器人已应用于10kv配网线路的带电断接引...
配网带电作业机器人激光剥线工具的控制系统及控制方法与流程

本发明涉及机器视觉控制领域,具体为配网带电作业机器人激光剥线工具的控制系统及控制方法。

背景技术:

1、目前,配网带电作业机器人已应用于10kv配网线路的带电断接引流线、加装接地环等作业。激光剥线工具作为机器人机械臂末端执行工具,可利用激光对线缆绝缘层进行非接触切割,并配合夹紧、进给、旋转、吹气和绝缘层剥离完成剥线过程。实际作业中,工具需要同步获取温度、压力、位置和电流等状态信息,并与机器人主控单元交换运动控制数据和作业状态数据。

2、针对上述作业过程,现有激光剥线工具通常由机器人机械臂带动至待剥线缆附近,夹紧机构对线缆进行定位和固定,旋转机构与进给机构配合激光器完成环向切割和轴向切割,气泵在切割过程中向激光作用区域供气,切割完成后再通过机械执行部件剥离绝缘层。工具控制端根据传感器采集结果控制电机、激光器和气泵运行,并通过无线通信与机器人主控单元完成作业指令和设备状态的传输。

3、现有控制方式在带电作业环境下仍存在进一步改进空间。激光器、电机和气泵同时工作时产生的负载变化容易引起供电电压波动,对传感器采样和执行控制产生影响;仅依据单一测量结果进行对中或夹紧判断时,难以在激光出光前进一步核验线缆外径及夹紧状态,辅助气压、旋转零位和激光器状态之间也缺少完整的联锁关系。另一方面,现场电磁干扰可能造成无线通信队列积压或链路中断,若不同类型数据缺少分级调度,链路恢复后又直接继续处理断联期间的控制指令,容易造成设备当前状态与控制指令不一致,影响后续剥线过程的连续执行。

4、因此,本发明提供了配网带电作业机器人激光剥线工具的控制系统及控制方法,以解决现有技术中存在的不足之处。

技术实现思路

1、针对现有技术的不足,本发明提供了配网带电作业机器人激光剥线工具的控制系统及控制方法,解决了现有配网带电作业机器人激光剥线过程中供电扰动、对中与外径校验不足、多执行器联锁不完善以及无线通信异常导致的控制可靠性和作业安全性不足问题。

2、为实现以上目的,本发明通过以下技术方案予以实现:

3、第一方面,本发明提供一种配网带电作业机器人激光剥线工具的控制系统,采用如下的技术方案:

4、一种配网带电作业机器人激光剥线工具的控制系统,包括电源管理模块、视觉机构模块、逻辑控制模块、执行驱动模块和数据交互模块。电源管理模块用于将输入直流电源分别转换为相互电气隔离的第一直流电源和第二直流电源;

5、视觉机构模块用于采集待剥线缆视觉图像;

6、逻辑控制模块用于根据待剥线缆视觉图像确定视觉外径并生成机械臂增量位姿调整数据和夹紧许可,根据夹紧机构的增量式编码器信号确定机械外径,比较视觉外径与机械外径形成外径一致性校验状态,获取辅助气压状态、旋转机构零位状态和激光器自检状态,并在夹紧完成后根据外径一致性校验状态、辅助气压状态、旋转机构零位状态和激光器自检状态生成出光许可;

7、执行驱动模块用于根据夹紧许可和出光许可驱动夹紧机构、进给机构、旋转机构、激光器和气泵;

8、数据交互模块用于与机器人主控单元交互机械臂增量位姿调整数据、协同反馈数据和状态监测数据。

9、通过采用上述技术方案,将视觉测量、机械测量、夹紧控制和激光出光控制建立为连续的控制关系。视觉外径用于形成夹紧前的几何测量结果,机械外径用于形成夹紧后的独立测量结果,通过比较视觉外径与机械外径形成外径一致性校验状态;

10、同时将辅助气压状态、旋转机构零位状态和激光器自检状态共同作为出光许可的判断条件,使夹紧、外径校验和激光出光按照确定的状态条件依次执行。

11、优选的,电源管理模块包括第一隔离供电单元和第二隔离供电单元,第一隔离供电单元和第二隔离供电单元均连接输入直流电源,第一隔离供电单元向执行驱动模块输出第一直流电源,第二隔离供电单元向视觉机构模块、逻辑控制模块和数据交互模块输出第二直流电源,第一隔离供电单元和第二隔离供电单元的输出端分别设置π型滤波结构。

12、通过采用上述技术方案,执行驱动回路与视觉、逻辑控制及数据交互回路采用相互电气隔离的供电路径,并分别进行输出滤波,降低夹紧电机、进给电机、旋转电机、激光器及气泵工作时产生的电源扰动向控制回路传递。

13、优选的,视觉机构模块包括视觉图像采集单元,视觉图像采集单元采集待剥线缆视觉图像;

14、逻辑控制模块提取并拟合待剥线缆左右边缘,根据像素当量确定视觉外径和待剥线缆中心位置,并根据多个待剥线缆中心位置拟合待剥线缆轴线方向。

15、通过采用上述技术方案,单次视觉采集结果同时用于获得视觉外径、待剥线缆中心位置和待剥线缆轴线方向,使视觉测量结果既参与机械臂闭环对中,又作为后续机械外径冗余校验的比较基准。

16、优选的,逻辑控制模块包括模拟信号采集单元和数字状态采集单元;

17、模拟信号采集单元采集温度信号、辅助气压信号和夹紧机构、进给机构及旋转机构对应电机的电流信号,数字状态采集单元采集限位开关信号和增量式编码器信号,逻辑控制模块根据辅助气压信号形成辅助气压状态;

18、激光器温度达到预设温度阈值时停止激光器pwm输出并保持气泵运行,夹紧机构、进给机构或旋转机构对应的电机电流达到预设电流阈值时停止全部pwm输出,限位开关触发时停止对应电机pwm输出。

19、通过采用上述技术方案,将温度、辅助气压、夹紧机构、进给机构及旋转机构对应电机的电流、限位状态和增量式编码器反馈纳入统一控制过程,在激光切割和机构运动过程中分别执行出光控制、过流控制和限位控制。

20、优选的,逻辑控制模块根据待剥线缆视觉图像确定待剥线缆中心位置和待剥线缆轴线方向,并得到待剥线缆相对于激光剥线工具轴线的位置偏差和姿态偏差;

21、位置偏差超过预设位置对中阈值或者姿态偏差超过预设姿态对中阈值时生成机械臂增量位姿调整数据,并由数据交互模块发送至机器人主控单元;

22、连续预设帧数的测量结果均满足位置偏差不大于预设位置对中阈值且姿态偏差不大于预设姿态对中阈值时生成夹紧许可。

23、通过采用上述技术方案,机械臂按照视觉测量结果重复执行测量、调整和再次测量,在位置偏差和姿态偏差连续满足设定条件后才生成夹紧许可,使机械臂闭环对中结果与夹紧动作直接关联。

24、优选的,夹紧机构包括左右夹紧块;

25、夹紧完成后,逻辑控制模块根据夹紧机构初始间距、左右夹紧块对应的增量式编码器累计脉冲数、丝杆导程和传动比确定机械外径,并比较机械外径与视觉外径得到外径一致性偏差;

26、外径一致性偏差不大于外径一致性允许阈值时确定外径一致性校验状态为通过,否则确定为未通过。

27、通过采用上述技术方案,夹紧后的机械位移反馈形成独立于视觉测量的机械外径,将视觉外径与机械外径进行交叉校验,使夹紧位置和待剥线缆外径状态在激光出光前得到再次确认。

28、优选的,逻辑控制模块在实际辅助气压不低于辅助气压阈值时确定辅助气压状态有效,在旋转机构位于预设初始零位时确定旋转机构零位状态有效,在激光器供电电压处于预设工作电压范围、激光器温度低于预设温度阈值且出光准备状态为就绪时确定激光器自检状态有效;

29、夹紧许可有效且夹紧完成、外径一致性校验状态为通过,并且辅助气压状态、旋转机构零位状态和激光器自检状态均有效时生成出光许可,否则撤销出光许可。

30、通过采用上述技术方案,将夹紧完成、外径一致性校验、辅助气压、旋转机构零位及激光器自身工作状态共同组成出光许可条件,任一条件不满足时停止出光许可,使激光器出光与当前机械状态和设备状态保持一致。

31、优选的,激光剥线工具还包括推杆和拔刀;

32、逻辑控制模块还用于读取待剥线缆材质类别和线径档位,并根据所读取的待剥线缆材质类别和线径档位确定激光功率、扫描速度、脉冲频率和离焦量;

33、执行驱动模块根据夹紧许可驱动夹紧机构,根据出光许可依次驱动旋转机构和激光器执行起始端环向切割、驱动进给机构和激光器执行轴向切割、驱动旋转机构和激光器执行目标端环向切割,并驱动气泵供气;

34、激光切割完成后,执行驱动模块驱动设置于所述激光剥线工具上的推杆推动拔刀进入绝缘层切缝,并驱动旋转机构带动拔刀剥离绝缘层。

35、通过采用上述技术方案,逻辑控制模块读取待剥线缆材质类别和线径档位,并根据所读取的待剥线缆材质类别和线径档位确定对应的激光工艺参数,按照起始端环向切割、轴向切割、目标端环向切割和绝缘层剥离的顺序完成作业,使激光切割过程与机械剥离过程形成连续执行关系。

36、优选的,数据交互模块包括无线通信单元和状态缓存单元,并将固定调度窗口依次划分为运动控制时段、协同反馈时段和状态监测时段;

37、通信队列积压且存在紧急安全指令时,将紧急安全指令安排至下一运动控制时段,并清除不包含温度异常状态、过流状态、限位状态和联锁状态的状态监测帧;

38、无线通信链路断开时,逻辑控制模块撤销出光许可,无线通信单元切换备用信道并按预设重连间隔重连;

39、链路恢复后先同步状态缓存单元中的设备状态,再接收新的控制指令,且不重放断联期间的控制指令。

40、通过采用上述技术方案,将运动控制数据、协同反馈数据和状态监测数据按照固定调度窗口分时传输,在通信队列积压时优先处理紧急安全指令,在无线通信链路恢复后先完成设备状态同步再接收新的控制指令,从而使通信异常处理与当前作业状态保持对应。

41、第二方面,本发明提供一种配网带电作业机器人激光剥线工具的控制方法,采用如下的技术方案:

42、一种配网带电作业机器人激光剥线工具的控制方法,应用于上述配网带电作业机器人激光剥线工具的控制系统,包括以下步骤:

43、电源管理模块将输入直流电源分别转换为相互电气隔离的第一直流电源和第二直流电源,逻辑控制模块执行上电自检;

44、视觉机构模块采集待剥线缆视觉图像,逻辑控制模块确定视觉外径、待剥线缆中心位置和待剥线缆轴线方向,根据待剥线缆与激光剥线工具轴线的位置偏差和姿态偏差生成机械臂增量位姿调整数据并由数据交互模块发送至机器人主控单元,连续预设帧数的位置偏差不大于预设位置对中阈值且姿态偏差不大于预设姿态对中阈值时生成夹紧许可,读取待剥线缆材质类别和线径档位,并根据所读取的待剥线缆材质类别和线径档位确定激光功率、扫描速度、脉冲频率和离焦量;

45、执行驱动模块根据夹紧许可驱动夹紧机构,逻辑控制模块根据夹紧机构初始间距、增量式编码器信号、丝杆导程和传动比确定机械外径,比较视觉外径与机械外径形成外径一致性校验状态;

46、夹紧完成且外径一致性校验状态为通过,辅助气压状态、旋转机构零位状态和激光器自检状态均有效时生成出光许可,执行驱动模块根据出光许可完成起始端环向切割、轴向切割、目标端环向切割和绝缘层剥离;

47、数据交互模块按固定调度窗口传输机械臂增量位姿调整数据、协同反馈数据和状态监测数据,通信队列积压且存在紧急安全指令时优先传输紧急安全指令,无线通信链路断开后切换备用信道并按预设重连间隔重连,链路恢复后先完成状态同步再接收新的控制指令。

48、通过采用上述技术方案,控制方法依次建立隔离供电、视觉测量及闭环对中、夹紧许可、机械外径冗余校验、出光许可、激光切割和通信异常处理过程,各阶段以前一阶段形成的测量结果或者状态结果作为后续控制条件,形成由目标感知至绝缘层剥离的连续控制流程。

49、优选的,在视觉闭环对中过程中,根据待剥线缆视觉图像确定视觉外径、待剥线缆中心位置和待剥线缆轴线方向;

50、当位置偏差或者姿态偏差超过对应阈值时生成机械臂增量位姿调整数据,机器人主控单元据此调整激光剥线工具的位置和姿态;

51、连续预设帧数的测量结果满足位置偏差和姿态偏差的对应条件后生成夹紧许可。

52、通过采用上述技术方案,夹紧许可直接由连续视觉闭环对中结果产生,减少单帧测量变化对夹紧时机的影响。

53、优选的,在夹紧完成后,根据夹紧机构初始间距、左右夹紧块对应的增量式编码器累计脉冲数、丝杆导程和传动比确定机械外径,并将机械外径与视觉外径进行比较;两者之间的外径一致性偏差不大于外径一致性允许阈值时,外径一致性校验状态为通过。

54、通过采用上述技术方案,利用视觉测量与机械位移反馈形成两种相互独立的外径测量结果,并在出光前完成一致性校验。

55、优选的,在形成出光许可时,同时判断夹紧许可、夹紧完成状态、外径一致性校验状态、辅助气压状态、旋转机构零位状态和激光器自检状态;夹紧许可有效且夹紧完成、外径一致性校验状态为通过,并且辅助气压状态、旋转机构零位状态和激光器自检状态均有效时生成出光许可,任一状态不满足对应条件时不生成出光许可或者撤销已生成的出光许可。

56、通过采用上述技术方案,将影响激光切割的机械状态、气路状态和激光器状态统一纳入出光控制条件,使出光状态随当前设备状态同步更新。

57、优选的,读取待剥线缆材质类别和线径档位,并根据所读取的待剥线缆材质类别和线径档位确定激光功率、扫描速度、脉冲频率和离焦量,生成出光许可后依次进行起始端环向切割、轴向切割和目标端环向切割,在激光切割过程中通过气泵供气,激光切割完成后通过设置于激光剥线工具上的推杆和拔刀完成绝缘层剥离。

58、通过采用上述技术方案,使待剥线缆材质类别和线径档位的读取、激光工艺参数确定、切割轨迹控制和绝缘层机械剥离按照同一作业流程连续执行。

59、优选的,在数据交互过程中,将固定调度窗口划分为运动控制时段、协同反馈时段和状态监测时段;通信队列积压且存在紧急安全指令时,优先在下一运动控制时段传输紧急安全指令;无线通信链路断开时撤销出光许可并切换备用信道进行周期重连,无线通信链路恢复后先同步当前设备状态,再接收新的控制指令。

60、通过采用上述技术方案,按照数据优先级完成分时通信,并使通信中断后的控制恢复以当前设备状态为基础,避免断联期间控制指令在链路恢复后继续影响当前作业状态。

61、本发明提供了配网带电作业机器人激光剥线工具的控制系统及控制方法。具备以下有益效果:

62、1.本发明通过电源管理模块将输入直流电源分别转换为相互电气隔离的第一直流电源和第二直流电源,并在第一隔离供电单元和第二隔离供电单元的输出端设置π型滤波结构,使执行驱动回路与视觉、逻辑控制及数据交互回路采用相互隔离的供电路径,能够减小电机启停、激光器出光及气泵运行产生的电源扰动对控制信号采集和处理过程的影响。

63、2.本发明通过视觉机构模块获得视觉外径、待剥线缆中心位置和待剥线缆轴线方向,根据位置偏差和姿态偏差完成闭环对中,并在夹紧后根据增量式编码器反馈确定机械外径,将机械外径与视觉外径进行一致性校验;在此基础上结合辅助气压状态、旋转机构零位状态和激光器自检状态生成出光许可,使夹紧、外径校验和激光出光按照明确的状态条件依次执行,降低对中偏差或者外径检测异常情况下继续出光的风险。

64、3.本发明通过固定调度窗口对机械臂增量位姿调整数据、协同反馈数据和状态监测数据进行分时传输,在通信队列积压时优先处理紧急安全指令;无线通信链路断开后撤销出光许可并执行备用信道切换和周期重连,链路恢复后先同步状态缓存单元中的设备状态再接收新的控制指令,从而使通信异常处理过程与当前设备状态保持一致,并避免断联期间的控制指令在链路恢复后再次执行。