一种数控电解加工机床多轴联动高精度定位控制方法与流程

摘要: 本发明涉及机床定位控制,具体而言,涉及一种数控电解加工机床多轴联动高精度定位控制方法。背景技术:1、数控电解加工机床通常具备三个或更多进给轴,各轴由伺服电机驱动...
一种数控电解加工机床多轴联动高精度定位控制方法与流程

本发明涉及机床定位控制,具体而言,涉及一种数控电解加工机床多轴联动高精度定位控制方法。

背景技术:

1、数控电解加工机床通常具备三个或更多进给轴,各轴由伺服电机驱动并配有光栅尺或旋转编码器等位置反馈元件,构成从工作台到主轴头的串联运动链。主轴头上安装工业相机,镜头朝向工作台,相机与工具电极位于同一末端刚体上,相机光学中心与工具中心点之间存在固定的空间偏置。

2、在非加工定位工况下,现有视觉定位方法通过相机采集工作台上的基准标志图像,将图像偏移量按固定比例系数换算为物理修正量,驱动进给轴完成定位修正。该方法隐含三项假设:相机与工具中心点之间的关系为手眼标定所得固定常量;图像偏移与工具中心点偏差之间为固定映射;单组视标的整体平移量即可代表定位误差。

3、在多轴联动位姿下,上述假设均不成立。运动链中各轴存在多项几何误差分量,其中角误差使整个末端刚体产生微小转动,相机光学中心和工具中心点因距转动中心的力臂长度不同而产生大小和方向均不相同的线位移。力臂长度随其他轴的位置变化,因此同一角误差分量在不同轴位姿下投影到像面的位移量不同,图像偏移与工具中心点偏差之间不存在固定映射关系。此外,平移偏差使视野内所有视标产生方向一致、大小近似相同的图像位移,而角偏差使不同位置的视标产生随位置变化的差异位移,取单组视标整体平移量的做法丢弃了位移场空间分布中携带的误差来源类型信息。上述问题导致现有视觉定位方法在某些位姿下过修正、在另一些位姿下欠修正,全行程定位精度不一致,难以满足数控电解加工机床对高精度定位的要求。

技术实现思路

1、本发明的主要目的在于提供一种数控电解加工机床多轴联动高精度定位控制方法,以至少解决现有技术中视觉定位采用固定换算系数导致多轴联动位姿下过修正或欠修正、全行程定位精度不一致的问题。

2、为了实现上述目的,根据本发明的一个方面,提供了一种数控电解加工机床多轴联动高精度定位控制方法,包括以下步骤:

3、建立多轴运动链几何误差模型,并获取工作台面状视标组中各个视标的三维坐标;

4、控制多轴运动链趋近目标位姿,并读取各个进给轴的编码器实际位置;

5、通过主轴共架相机采集图像提取实测图像坐标,结合所述编码器实际位置与所述三维坐标计算理论图像坐标,生成视标位移场;

6、基于所述编码器实际位置和所述多轴运动链几何误差模型,计算当前位姿下各个轴几何误差分量到所述视标位移场的位姿相关投影系数矩阵,以及到工具中心点位置偏差的传递系数矩阵;

7、基于所述位姿相关投影系数矩阵对所述视标位移场进行分解,获得各个轴误差贡献分量;

8、基于所述传递系数矩阵和所述主轴共架相机与工具中心点的偏置向量,将所述各个轴误差贡献分量映射为工具中心点位置偏差,逆解生成各个轴位置修正指令;

9、执行所述各个轴位置修正指令并复采验证,直至所述视标位移场的均方根值小于定位精度阈值。

10、可选地,所述建立多轴运动链几何误差模型,包括:

11、获取机床结构参数、相机内参标定结果、主轴共架相机相对于主轴端面的手眼标定结果,以及各个进给轴的几何误差参数;

12、基于所述机床结构参数建立从工作台坐标系经各个进给轴到主轴头坐标系再到相机像面的运动学传递模型,并对所述几何误差参数进行参数化处理,推导各个轴几何误差分量到相机像面视标位移以及到工具中心点位置偏差的解析传递关系;

13、基于所述解析传递关系进行灵敏度分析,选取在定位行程范围内对工具中心点位置偏差的灵敏度系数大于设定灵敏度阈值的误差分量,构建在线待估误差分量集合,并输出参数化的多轴运动链几何误差模型。

14、可选地,所述获取工作台面状视标组中各个视标的三维坐标,包括:

15、在工作台或夹具上以非共线方式布设不少于四个视标,使得所述视标在主轴共架相机定位工作距离下的单次成像视野内呈面状分布;

16、采用精密测量设备获取各个视标在工作台坐标系中的三维坐标,并建立视标坐标系与工件坐标系之间的变换关系;

17、基于预设的运动学模型,预存任意位姿处各个视标理论图像坐标的计算接口。

18、可选地,所述控制多轴运动链趋近目标位姿,并读取各个进给轴的编码器实际位置,包括:

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、应用本技术的技术方案,通过在当前编码器位姿下在线计算位姿相关投影系数矩阵,使各轴几何误差分量到像面位移的投影关系随位姿更新而非使用固定系数,能够在不同联动位姿下正确反映角误差力臂效应引起的投影变化,有利于消除固定映射导致的过修正和欠修正;通过保留面状视标组中各个视标的位移向量构成位移场,使平移误差与角误差在像面上的不同投影模式得以区分,能够将位移场正确分解为各轴误差贡献分量;通过传递系数矩阵和主轴共架相机与工具中心点偏置向量的力臂效应,将各轴误差贡献分量映射为工具中心点实际位置偏差而非相机观测点偏差,能够针对工具中心点的真实定位误差生成修正量;通过执行修正指令后复采验证并迭代,以视标位移场均方根值和分解残差作为收敛判据,能够保证定位精度和分解结果的可信性。