一种基于机械臂的轨道仿形探伤方法

1.一种基于机械臂的轨道仿形探伤方法，其特征在于，包括以下步骤：S1人工示教；通过示教者与机械臂协同完成对无缝轨道接头的仿形探伤作业，机械臂末端搭载六维力/力矩传感器，示教者佩戴肌电手环，拖动机械臂完成探伤作业；机械臂以一定的频率f记录完成作业时的末端位置、速度及加速度，肌电手环以相同频率f对示教者的刚度数据进行采集，六维力/力矩传感器同样地以频率f测量末端接头处的接触力，重复示教m次；S2轨迹生成；将 m 次重复示教产生的末端数据集采用动态运动基元对示教轨迹进行学习；根据步骤S1中获取的示教轨迹的复杂程度确定基函数数目N和系统增益项，计算得到目标强迫函数 ，通过目标强迫函数可求得基函数权重，进而得到学习轨迹的强迫函数f，将f引入机械臂末端系统得到机械臂学习轨迹；S3回归曲线生成；将肌电手环测得的刚度数据映射到人手臂实际的末端刚度，分别建立人手臂末端刚度及机械臂末端力的高斯混合模型，进行高斯混合回归，分别获得人手臂末端刚度和机械臂末端力的回归曲线；S4自主探伤；机械臂按照步骤S2生成的学习轨迹，带动探伤装置对无缝轨道接头进行探伤，基于位置的变阻抗控制策略，保证检测过程中探伤装置与接头表面的接触力与步骤S3中模型计算曲线的限定范围内；步骤S2中，所述末端数据集为 m 次示教过程中，在每条轨迹上采集的具有n个数据点的末端数据集 ，其中 为采样点的时间向量， 、 、 分别为机械臂末端采样点的空间坐标向量、速度向量和加速度向量；步骤S2中，所述动态运动基元的学习过程如下：确定基函数数目N和系统增益项，通过所述末端数据集可得到目标强迫函数 ： (1)其中， 和 为系统增益项，g为轨迹目标值，即 ；非线性部分由一系列高斯函数加权叠加而成，通过改变权重值来模拟轨迹： (2)其中， ；x为用于控制f的相位，采用的是经典系统， ；N为基函数的个数，通常轨迹越复杂就需要更多的基函数； 为对应基函数 的权重，可由下式求得： (3)式（3）中， ， ；将求得的权重值代入式（2）得到完整的非线性部分，再通过下式可计算求得学习轨迹的位置、速度及加速度信息： (4)。 2.根据权利要求1所述的基于机械臂的轨道仿形探伤方法，其特征在于，步骤S3中，回归曲线计算过程如下：根据步骤S1中示教时记录的刚度数据、末端接触力数据以及步骤S2中得到的学习轨迹位置信息得到的数据集 ，记 ， ， ；采用高斯混合模型对数据进行编码，其中某个数据点 的概率为： (5)其中，R为实数域， 为先验概率，且 ，K为高斯分布的个数，D为数据的维度， 分别表示第k个高斯分布的均值和协方差矩阵，给定输入变量 ，输出 和 的条件概率分布分别为： (6)其中 和 分别表示后验概率中第k个高斯分布的均值和方差： (7)其中 和 分别为F或K和y的第k个高斯分布均值， 和 为协方差矩阵： (8) 在第k个高斯分布中的概率为： (9)高斯混合回归为给定 下 和 的条件概率分布的期望： (10)。 3.根据权利要求1或2所述的基于机械臂的轨道仿形探伤方法，其特征在于，步骤S4中，所述自主探伤的过程如下：首先将刚度期望曲线 、末端力期望曲线 、以及学习轨迹 和机械臂末端实际值之间的误差输入到变阻抗控制器中后输出位移修正量 ，然后结合机械臂末端探伤装置原始位置，获得机械臂所要调整的目标位置，目标位置经机械臂逆运动学转换成各个关节的角度 ，输入到位置控制环中，然后经机械臂运动学正解输出实际调整的位置q，此时探伤装置与轨道接头表面会产生新的接触力 ，从而实现了闭环控制。 4.根据权利要求1或2所述的基于机械臂的轨道仿形探伤方法，其特征在于，所述机械臂固定安装于检测车辆上，且机械臂端部安装有六维力/力矩传感器和检测探头；示教者手臂上佩戴有所述肌电手环，机械臂、力矩传感器、检测探头和肌电手环均与上位机电连接。