一种锌熔铸段槽周清理机器人力位混合控制方法

摘要: 本发明涉及工业机器人智能控制,具体涉及一种锌熔铸段槽周清理机器人力位混合控制方法。背景技术:1、目前,锌锭表面清理作业主要采用人工刮除或传统机械处理方式。人工刮...
一种锌熔铸段槽周清理机器人力位混合控制方法

本发明涉及工业机器人智能控制,具体涉及一种锌熔铸段槽周清理机器人力位混合控制方法。

背景技术:

1、目前,锌锭表面清理作业主要采用人工刮除或传统机械处理方式。人工刮除作业存在以下突出问题:一是劳动强度大,作业环境恶劣,工人需要在高温、粉尘环境下长时间工作;二是清理质量不稳定,不同操作人员的技能水平差异导致刮除力度不均匀,容易对锌锭基体造成损伤或清理不彻底;三是生产效率低,人工操作难以满足现代化冶炼企业大规模生产需求。

2、近年来,随着冶金行业自动化水平的不断提升,部分企业开始尝试将工业机器人应用于锌锭处理环节。在锌片熔铸、扒渣、码垛等环节已成功应用机器人技术,实现了从锌片到锌锭的自动化生产。但在锌锭表面清理这一关键环节,特别是针对槽周边缘氧化层和杂质的精确刮除,现有技术仍存在明显不足。现有的机器人控制方法主要采用传统的位置控制,由于槽周表面锌渣的氧化程度不同,其不一致的表面状况导致机器人难以保持恒定的刮除力度。由此容易出现刮除力过大造成基体损伤,或刮除力不足导致清理不彻底的问题。此外,传统示教器编程方式在空间可达性和路径规划灵活性方面存在固有局限,难以实现多模态的传感器信息集成,控制参数的在线监测与动态调整。

3、随着冶金行业数字化转型和智能化升级的深入推进,市场对锌锭表面清理的自动化、智能化水平提出了更高要求。因此,亟需一种能够实现恒定刮除力控制、具备智能作业位置实时调整能力的工业机器人控制方法,以满足现代化冶炼企业对锌锭表面处理质量和效率的双重需求。

技术实现思路

1、本发明的主要目的在于提供一种锌熔铸段槽周清理机器人力位混合控制方法,用于解决上述背景技术中提出的问题。

2、为实现上述目的,本发明提供了一种锌熔铸段槽周清理机器人力位混合控制方法,现有锌锭槽周清理工艺中,机器人仅依赖位置控制,无法适应氧化层厚度不均带来的表面刚度变化,导致刮除力时大时小、清理质量不一致,且示教编程无法在线调整路径和力控参数;本发明解决其技术问题所采用的技术方案是:提供一种“视觉-力觉”双闭环的力位混合控制方法,将上位机视觉引导、力觉阻抗调节与速度层控制融为一体,包括以下步骤:

3、s1、实时提取槽周边缘的笛卡尔空间坐标及锌渣分布密度,生成位置参考信号;

4、s1.1、工业3d相机与机器人完成手眼标定,建立像素坐标系、相机坐标系与机器人基坐标系之间的精确变换关系;

5、s1.2、机器人携带末端刮刀移至安全点,触发相机对目标锌锭进行扫描;通过上位机集成的图像处理算法,对获取的点云或深度图像进行实时分析;

6、s1.3、运用边缘检测算法结合三维点云拟合,精确提取锌锭槽口边缘的三维空间轮廓,得到一系列边缘基准点;

7、s1.4、通过对点云局部高度变化和颜色/纹理特征的表面分析,估算锌渣或氧化层的分布密度及大致厚度;

8、s1.5、以边缘基准点为基线,结合表面分析结果,规划清理作业路径。

9、s2、基于s1中的位置参考信号,获取末端执行器的实际位置,计算位置跟踪误差变量:

10、;

11、其中,为位置参考信号;为末端执行器的实际位置。

12、s3、获取s2中末端执行器与锌锭表面的接触并与期望恒力阈值构建力误差:

13、;

14、其中,为末端执行器与锌锭表面的接触力;为期望恒力阈值。

15、s4、在与锌锭接触的笛卡尔空间的z方向,将s3中的力误差通过可调刚度矩阵转换为修正速度:

16、,

17、,

18、,

19、在z方向形成力位混合控制器;其中,代表机械臂末端方向上的跟踪误差,代表机械臂末端方向上的跟踪误差,代表机械臂末端方向上的跟踪误差,kf、kp为正定的常数增益矩阵;代表机械臂末端方向上的速度,代表机械臂末端方向上的速度,代表机械臂末端方向上的速度。

20、s5、上位机将s4中的速度控制指令发送至机器人控制器;

21、s5.1、建立上位机与机器人控制器之间的通讯,使用高级编程语言实现s4中的速度控制算法;

22、s5.2、以高速率将计算得到的笛卡尔速度指令发送至机器人控制器。

23、s6、系统持续将s2中末端执行器的法向接触力稳定在期望阈值附近,实现恒力控制,系统实时分析力信号曲线和位置跟踪情况;单次清理完成后,触发视觉系统进行快速复检,量化评估表面粗糙度,记录作业数据。

24、本发明的有益效果体现在:

25、通过机器视觉系统对锌锭表面进行识别,根据槽周边缘几何特征规划最优刮除路径;然后由上位机编程实现外部引导控制,通过力觉传感器实时监测刮除过程中的接触力,在位置控制基础上引入力反馈环,形成力位混合控制;当工业机器人执行刮除作业时,系统根据预设的恒定刮除力阈值,动态调整机器人末端执行器的姿态和进给速度,确保在整个清理过程中保持恒定的接触力度;本发明突破了传统示教器编程的空间局限,实现了基于视觉的智能化路径规划与基于力觉的自适应控制相结合,有效解决现有技术中刮除力度不均、清理质量不稳定的问题,显著提高锌锭表面清理的精度、一致性和自动化水平。

1.一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于,包括以下步骤:

2.根据权利要求1所述的一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于:在s1中,槽周边缘的笛卡尔空间坐标的建立包括以下步骤:

3.根据权利要求2所述的一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于:在s1中,通过对点云局部高度变化和颜色/纹理特征的表面分析,估算锌渣或氧化层的分布密度及大致厚度。

4.根据权利要求3所述的一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于:在s1中,以边缘基准点为基线,结合表面分析结果,规划清理作业路径。

5.根据权利要求4所述的一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于:在s1中,对于氧化层较厚区域,路径在法向上进行适当内偏置,确保刮刀能有效切入;对于较薄区域,则贴近表面,生成一条由离散三维空间坐标点序列构成的位置参考信号,并发送至控制单元。

6.根据权利要求5所述的一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于:在s2中,所述位置跟踪误差定义为:

7.根据权利要求6所述的一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于:在s3中,所述力误差定义为:

8.根据权利要求7所述的一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于:在s4中,所述修正速度包括:

9.根据权利要求8所述的一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于:在s5中,建立上位机与机器人控制器之间的通讯,使用高级编程语言实现s4中的速度控制算法,以高速率将计算得到的笛卡尔速度指令发送至机器人控制器。

10.根据权利要求9所述的一种锌熔铸段槽周清理机器人力位混合控制方法,其特征在于:在s6中,系统实时分析力信号曲线和位置跟踪情况;单次清理完成后,触发视觉系统进行快速复检,量化评估表面粗糙度,记录作业数据。