一种电子产品焊接机械臂高精度校准系统的制作方法

本发明涉及智能焊接系统，具体为一种电子产品焊接机械臂高精度校准系统。

背景技术：

1、智能焊接系统技术领域包含对电子产品组装过程中焊接工序的自动化控制与执行，其核心内容涉及焊接路径规划、焊点定位补偿以及焊接参数动态调节，整体上涵盖从焊前准备到焊后检测的全流程协同运作，包括机械臂运动学建模、传感器数据融合以及实时反馈修正机制，以实现焊接作业的稳定性和一致性。

2、其中，一种电子产品焊接机械臂高精度校准系统是指针对焊接机械臂在作业中因温度变化、机械磨损或工件公差导致的焊点偏移问题，采用工业相机拍摄焊盘标记点并通过灰度梯度法提取像素级坐标差异，结合激光位移传感器测量机械臂各关节实际转角与理论值的偏差量，利用六维力传感器采集焊针接触工件时的瞬时反作用力数值，再依据这些实测数据生成补偿向量并写入机械臂控制器中的运动指令序列，从而在每次焊接循环前自动修正末端执行器的空间位姿。

技术实现思路

1、针对现有技术的不足，本发明提供了一种电子产品焊接机械臂高精度校准系统，具备无迭代限位校验、补偿向量按比例重分配及相位对齐平滑注入的功能，解决了上述背景技术中提到的问题。

2、为解决上述技术问题，本发明提供如下技术方案：

3、一种电子产品焊接机械臂高精度校准系统，包括以下模块：

4、数据获取模块：同步采集编码器、激光位移传感器、六维力传感器及工业相机输出数值，生成校准多源传感数据组；

5、补偿向量生成模块：调取校准多源传感数据组，运算实际采集数值与预设数值的差距，输出初始关节补偿向量集；

6、补偿指令处理模块：调取初始关节补偿向量集与预设三类限位阈值，对由各关节当前角度与初始关节补偿向量集求和得到的预测角度，基于三类限位阈值进行三级限位比较与剩余量分配，经硬限位校验后输出限位安全补偿向量集；

7、指令注入执行模块：基于限位安全补偿向量集生成等幅子步，根据伺服周期定时差值分步注入子步并写入寄存器，持续更新计数生成关节位置更新量；

8、状态监测模块：读取编码器所得的实际关节角度与关节位置更新量所提供的期望关节角度，运算二者差值对比预设跟随偏差阈值，输出关节跟随偏差值。

9、优选的，所述校准多源传感数据组包括各关节当前角度值、各关节转角偏差绝对值、焊针接触反作用力数值、焊盘标记点像素坐标。

10、优选的，所述初始关节补偿向量集由像素坐标偏差分量、转角偏差比值分量、接触力差值分量经预标定的映射矩阵转换至关节空间后构成；所述像素坐标偏差分量由焊盘标记点像素坐标与理论坐标的差值运算得到，所述转角偏差比值分量由各关节转角偏差绝对值与预设偏差阈值的比值运算得到，所述接触力差值分量由焊针接触反作用力与预设力阈值的差值运算得到。

11、优选的，所述三类限位阈值包括硬限位阈值、软限位阈值、动态安全余量阈值；所述硬限位阈值为关节运动的物理极限边界值，所述软限位阈值为关节运动的预警边界值，所述动态安全余量阈值为关节正常运行的安全边界值，且三类阈值数值依次递减。

12、优选的，所述三级限位比较具体为：由各关节当前角度值与初始关节补偿向量集中对应的补偿向量分量求和得到预测角度值，将预测角度值与硬限位阈值比较，大于等于硬限位阈值则标记一级风险并将该关节补偿向量分量截断至硬限位阈值减去当前角度值同时计算截断剩余量；将预测角度值与软限位阈值比较，大于等于软限位阈值且小于硬限位阈值则标记二级风险并调用所述校准多源传感数据组中的关节转角偏差绝对值查预设偏差衰减系数表获得衰减因子，将补偿向量分量乘以衰减因子同时计算衰减剩余量；将预测角度值与动态安全余量阈值比较，大于等于动态安全余量阈值且小于软限位阈值则标记三级风险且补偿向量分量保持不变。

13、优选的，所述剩余量分配具体为：求和所有一级风险关节的截断剩余量与二级风险关节的衰减剩余量得到总剩余量，统计无风险关节集合中各关节的软限位距离，将总剩余量按各关节软限位距离占无风险关节软限位距离总和的比例分配并累加到对应关节补偿向量分量上。

14、优选的，所述硬限位校验具体为：二次遍历所有关节将更新后的预测角度值与硬限位阈值比较，若有超过硬限位阈值的关节则将其补偿向量分量截断至硬限位阈值减去当前角度值，并将截断量按其余未超硬限位关节的软限位距离比例分配，重复该校验过程直至无关节预测角度值超过硬限位阈值。

15、优选的，所述等幅子步由限位安全补偿向量集中各关节补偿向量分量除以预设梯形速度过渡步数参数得到；所述分步注入具体为：读取伺服周期定时器计数值与理想周期计数值的差值，若差值绝对值小于预设抖动阈值则读取当前周期剩余时间与半周期时长比较，若当前周期剩余时间大于等于半周期时长则本周期注入两个子步，若当前周期剩余时间小于半周期时长则本周期注入一个子步，将子步值与上一周期末指令值相加后写入伺服控制器的位置寄存器。

16、优选的，所述关节位置更新量由持续更新已注入子步计数直至所有子步注入完毕后生成，该关节位置更新量作为各关节期望角度值供状态监测模块调用。

17、优选的，所述关节跟随偏差值由实际角度值与期望角度值的差值与预设跟随偏差阈值比较得到；所述实际角度值为各关节当前角度值，由编码器读取，所述期望角度值由关节位置更新量提供。

18、与现有技术相比，本发明提供了一种电子产品焊接机械臂高精度校准系统，具有如下有益效果：该方案通过将补偿向量与关节当前角度求和得到预测角度，并与硬限位、软限位、动态安全余量三级阈值分级比较，对越界补偿量执行截断或衰减，再将剩余量按无风险关节的软限位距离比例重新分配，经二次硬限位校验后输出限位安全补偿向量集，由此无需迭代优化即可完成限位校验，大幅降低控制器计算负荷，同时避免单一截断造成的补偿浪费，提升补偿向量在安全范围内的利用率；进一步将限位安全补偿向量集拆分为等幅子步，根据伺服周期定时器计数值与理想值的差值判断周期稳定性，再依据当前周期剩余时间与半周期时长的比较结果决定本周期注入子步数量，将子步值与上一周期末指令值相加后写入位置寄存器，实现与伺服周期相位对齐的动态注入，避免固定步长注入带来的速度突变，达到梯形速度平滑过渡，抑制焊针因指令跳变产生的抖动；结合编码器实际关节角度与关节位置更新量的差值比对预设跟随偏差阈值输出关节跟随偏差值，提供校准执行精度的实时监测依据，强化系统闭环可控性，适配电子产品焊接高速高密度校准场景。

1.一种电子产品焊接机械臂高精度校准系统，其特征在于，包括以下模块：

2.根据权利要求1所述的一种电子产品焊接机械臂高精度校准系统，其特征在于：所述校准多源传感数据组包括各关节当前角度值、各关节转角偏差绝对值、焊针接触反作用力数值、焊盘标记点像素坐标。

3.根据权利要求2所述的一种电子产品焊接机械臂高精度校准系统，其特征在于：所述初始关节补偿向量集由像素坐标偏差分量、转角偏差比值分量、接触力差值分量经预标定的映射矩阵转换至关节空间后构成；所述像素坐标偏差分量由焊盘标记点像素坐标与理论坐标的差值运算得到，所述转角偏差比值分量由各关节转角偏差绝对值与预设偏差阈值的比值运算得到，所述接触力差值分量由焊针接触反作用力与预设力阈值的差值运算得到。

4.根据权利要求1所述的一种电子产品焊接机械臂高精度校准系统，其特征在于：所述三类限位阈值包括硬限位阈值、软限位阈值、动态安全余量阈值；所述硬限位阈值为关节运动的物理极限边界值，所述软限位阈值为关节运动的预警边界值，所述动态安全余量阈值为关节正常运行的安全边界值，且三类阈值数值依次递减。

5.根据权利要求3所述的一种电子产品焊接机械臂高精度校准系统，其特征在于：所述三级限位比较具体为：由各关节当前角度值与初始关节补偿向量集中对应的补偿向量分量求和得到预测角度值，将预测角度值与硬限位阈值比较，大于等于硬限位阈值则标记一级风险并将该关节补偿向量分量截断至硬限位阈值减去当前角度值同时计算截断剩余量；将预测角度值与软限位阈值比较，大于等于软限位阈值且小于硬限位阈值则标记二级风险并调用所述校准多源传感数据组中的关节转角偏差绝对值查预设偏差衰减系数表获得衰减因子，将补偿向量分量乘以衰减因子同时计算衰减剩余量；将预测角度值与动态安全余量阈值比较，大于等于动态安全余量阈值且小于软限位阈值则标记三级风险且补偿向量分量保持不变。

6.根据权利要求5所述的一种电子产品焊接机械臂高精度校准系统，其特征在于：所述剩余量分配具体为：求和所有一级风险关节的截断剩余量与二级风险关节的衰减剩余量得到总剩余量，统计无风险关节集合中各关节的软限位距离，将总剩余量按各关节软限位距离占无风险关节软限位距离总和的比例分配并累加到对应关节补偿向量分量上。

7.根据权利要求6所述的一种电子产品焊接机械臂高精度校准系统，其特征在于：所述硬限位校验具体为：二次遍历所有关节将更新后的预测角度值与硬限位阈值比较，若有超过硬限位阈值的关节则将其补偿向量分量截断至硬限位阈值减去当前角度值，并将截断量按其余未超硬限位关节的软限位距离比例分配，重复该校验过程直至无关节预测角度值超过硬限位阈值。

8.根据权利要求1所述的一种电子产品焊接机械臂高精度校准系统，其特征在于：所述等幅子步由限位安全补偿向量集中各关节补偿向量分量除以预设梯形速度过渡步数参数得到；所述分步注入具体为：读取伺服周期定时器计数值与理想周期计数值的差值，若差值绝对值小于预设抖动阈值则读取当前周期剩余时间与半周期时长比较，若当前周期剩余时间大于等于半周期时长则本周期注入两个子步，若当前周期剩余时间小于半周期时长则本周期注入一个子步，将子步值与上一周期末指令值相加后写入伺服控制器的位置寄存器。

9.根据权利要求8所述的一种电子产品焊接机械臂高精度校准系统，其特征在于：所述关节位置更新量由持续更新已注入子步计数直至所有子步注入完毕后生成，该关节位置更新量作为各关节期望角度值供状态监测模块调用。

10.根据权利要求9所述的一种电子产品焊接机械臂高精度校准系统，其特征在于：所述关节跟随偏差值由实际角度值与期望角度值的差值与预设跟随偏差阈值比较得到；所述实际角度值为各关节当前角度值，由编码器读取，所述期望角度值由关节位置更新量提供。