一种基于接触式相对误差测量的双机器人协同运动学标定方法
本发明属于工业机器人高精度控制与标定,具体地,涉及一种基于接触式相对误差测量的双机器人协同运动学标定方法。
背景技术:
1、在航空航天大部件装配、薄壁件双面镜像铣削等高端制造领域,双机器人协同作业系统被广泛应用。这类任务对两台机器人末端执行器之间的相对位姿同步精度要求极高(通常要求亚毫米级)。目前,提高双机器人协同精度的主要方法是分别提高单台机器人的绝对定位精度。常用的手段是利用激光跟踪仪等高精度外部测量设备,对单台机器人进行运动学参数标定。
2、然而,这种依赖绝对测量的独立标定方法存在以下缺陷:
3、1.基坐标系配准误差的引入:即使单台机器人绝对精度很高,但在双机协同系统中,必须通过激光跟踪仪将两台机器人的基坐标系统一。这一坐标变换过程会引入不可避免的配准误差,导致绝对误差转化为两机之间的相对误差。
4、2.测量成本高且不便于现场部署:激光跟踪仪价格昂贵,且在复杂的加工现场存在光路遮挡问题,难以实现原位标定。
5、3.基于轨迹补偿的方法缺乏泛化性:近期有研究采用直接测量相对误差并进行迭代学习补偿的方法,虽然能提高特定轨迹的精度,但无法修正机器人底层的运动学模型。一旦更换加工轨迹,就需要重新进行多次迭代补偿,效率较低。
6、因此,急需一种成本低廉、无需昂贵外部设备,且能直接利用两台机器人之间的相对误差来辨识并修正底层运动学参数的双机器人标定方法。
技术实现思路
1、为解决现有技术存在的不足,本发明提出了一种基于接触式相对误差测量的双机器人协同运动学标定方法,利用低成本的正交千分表测量装置获取高精度的相对误差,构建双机闭环运动学误差模型,通过数值优化算法直接辨识出两台机器人的运动学参数偏差,从而从根本上提升双机系统的全局协同精度。
2、本发明通过以下技术方案实现:一种基于接触式相对误差测量的双机器人协同运动学标定方法:所述方法具体包括以下步骤:
3、s1.构建接触式相对误差测量装置及双机闭环运动学链,在主机器人末端安装测量模块,在从机器人末端安装参考模块,使两机器人末端在协同作业时保持接触状态,定义双机闭环运动学链;
4、s2.建立双机器人差分运动学相对误差模型,基于机器人微分运动学原理和指数积模型,分别构建两台机器人的运动学误差向末端位姿误差映射的几何雅可比矩阵,以此描述机器人各连杆参数的微小变化对其tcp末端位姿误差的线性映射关系;
5、s3.设计双机协同标定轨迹并采集相对误差数据,规划覆盖双机器人共享工作空间的协同标定轨迹,通过测量模块获取两机器人末端的相对位移变化量,将其转换为全局坐标系下的相对位姿误差;
6、s4.构建全局超定方程组,合并两台机器人的待辨识运动学参数,结合各采样点的误差映射关系构建系统级辨识矩阵,堆叠所有采样点的实测误差与辨识矩阵数据,形成超定方程组;
7、s5.采用非线性阻尼最小二乘法求解超定方程组,迭代计算得到两台机器人各自的运动学参数偏差;
8、s6.将求解得到的参数偏差补偿至双机器人控制器的运动学模型中,完成双机器人协同运动学标定。
9、进一步地,在s1中,所述测量模块为两组正交布置的千分表,所述参考模块为标准基准钢球;
10、分别建立主、从机器人理想模型,模拟实际制造误差,设定测量基准坐标系并构建主、从机器人的末端工具坐标系,以此定义双机闭环运动学链。
11、进一步地,在s3中,所述协同标定轨迹为多轴联动的空间螺旋线;
12、将标定轨迹离散为多个采样点,通过理想运动学模型的逆解算法计算两台机器人在各采样点的关节角度指令,驱动双机器人同步运动。
13、进一步地,在s3中,所述相对位姿误差转换过程具体为:
14、根据理想关节角度指令计算出主从机器人在每一个采样点时真实的末端位姿,根据理想模型计算各采样点主从机器人之间的理想相对位姿,进而得到各采样点处理论上的纯几何相对位姿误差;
15、根据正交千分表的机械安装矩阵,将纯几何相对位姿误差投影到传感器的三个正交测量方向上,模拟出千分表的原始位移读数;
16、注入白噪声后对含噪的测量数据通过滤波器进行平滑处理;
17、将滤波后的千分表读数,通过安装偏置矩阵的逆矩阵,重新投影回世界坐标系,得到用于标定算法的实测相对位姿误差向量。
18、进一步地,在s5中,迭代过程中根据目标函数残差平方和的变化动态调整阻尼因子:若残差下降则减小阻尼因子以加快收敛,若残差上升则增大阻尼因子并拒绝本次参数更新以保证稳定性;当相邻两次迭代的参数变化量小于设定阈值时,输出最终辨识出的参数偏差向量。
19、进一步地,在s6中,拆分输出最终辨识出的参数偏差向量,得到主从机器人的参数误差补偿值;将其补偿值指数积模型的参数表中,更新运动学模型;并通过新轨迹进行测试。
20、一种基于接触式相对误差测量的双机器人协同运动学标定系统;
21、所述系统包括预处理模块、差分误差测量模块、轨迹标定及位姿误差测量模块、标定方程构建模块、参数迭代模块和补偿更新模块;
22、所述预处理模块,用于构建接触式相对误差测量装置及双机闭环运动学链,在主机器人末端安装测量模块,在从机器人末端安装参考模块,使两机器人末端在协同作业时保持接触状态,定义双机闭环运动学链;
23、所述差分误差测量模块,用于建立双机器人差分运动学相对误差模型,基于机器人微分运动学原理和指数积模型,分别构建两台机器人的运动学误差向末端位姿误差映射的几何雅可比矩阵,以此描述机器人各连杆参数的微小变化对其tcp末端位姿误差的线性映射关系;
24、所述轨迹标定及位姿误差测量模块,用于设计双机协同标定轨迹并采集相对误差数据,规划覆盖双机器人共享工作空间的协同标定轨迹,通过测量模块获取两机器人末端的相对位移变化量,将其转换为全局坐标系下的相对位姿误差;
25、所述标定方程构建模块,用于构建全局超定方程组,合并两台机器人的待辨识运动学参数,结合各采样点的误差映射关系构建系统级辨识矩阵,堆叠所有采样点的实测误差与辨识矩阵数据,形成超定方程组;
26、所述参数迭代模块,用于采用非线性阻尼最小二乘法求解超定方程组,迭代计算得到两台机器人各自的运动学参数偏差;
27、所述补偿更新模块,用于将求解得到的参数偏差补偿至双机器人控制器的运动学模型中,完成双机器人协同运动学标定。
28、一种计算机装置设备系统,包括存储器、处理器及存储在存储器上的计算机程序,所述处理器执行所述计算机程序以实现上述方法的步骤
29、一种计算机可读存储介质,其上存储有计算机程序/指令,该计算机程序/指令被处理器执行时实现上述方法的步骤。
30、一种计算机程序产品,包括计算机程序/指令,该计算机程序指令被处理器执行时实现上述方法的步骤。
31、相较于现有技术,本发明的有益效果为:
32、本发明直接针对协同精度优化,跨过了传统单机器人分别独立标定中的基坐标系配准误差环节,直接以相对位姿误差为目标进行优化,标定后的双机协同精度显著高于独立绝对标定。
33、本发明使用千分表和钢球构成的omdi装置(精度可达5),成本不到激光跟踪仪的百分之一,且对工厂环境光照、遮挡不敏感,支持原位快速复标,标定成本极低,适应工业现场。
34、本发明可提升全局协同精度,区别于现有的多点标定等方法,本发明中协同标定点位可覆盖更大的工业机器人作业空间,双机器人系统同步标定完成后,双机器人执行任何新的协同轨迹,均能保持较高的相对精度,泛化能力强。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com