本发明涉及机器人运动学参数标定领域,具体涉及一种机器人运动学参数标定的位姿选取方法。
背景技术:
机器人在生产加工过程中优化加工、装配等因素造成机器人结构参数产生误差,会导致机器人的精度降低,所以在出厂之前必须要对机器人的运动学参数进行标定。目前采用的标定方法均是采集多组末端位姿,利用理论和实际的误差来进行优化辨识。由于机器人参数非常多,需要采集非常多位姿点来提高机器人运动学参数的辨识精度,这样导致参数标定需要花费非常多的资源。机器人标定需要采集的位姿点遍布机器人末端动平台的工作空间中,这样才能保证标定结果的准确性。由于采集的位姿点数非常多,传统的优化算法不能一次优化所有的标定点,而且计算难度大,传统的优化方法需要花费更多的计算资源来进行优化。在机器人工作空间中随机采集测量位姿会使参数误差辨识雅可比矩阵的能观指数降低,使得参数误差辨识雅可比矩阵对运动学误差参数不敏感,辨识结果鲁棒性差,辨识精度差。生产过程中必须对所有机器人进行标定,亟需要提高位姿采集的速度,提高标定效率;并且,需要保证辨识结果的鲁棒性和精度,需要位姿测量点使得参数误差辨识雅可比矩阵的能观指数最优。
技术实现要素:
本发明针对参数标定位姿优化选取的难题,提供一种机器人运动学参数标定位姿优化选取方法,以期通过对机器人运动学参数误差标定过程中测量位姿的优化选取,使得参数误差辨识雅可比矩阵的能观指数最优,从而提高参数标定的鲁棒性和精度。
本发明为达到上述发明目的,采用如下技术方案:
本发明一种机器人运动学参数标定位姿优化选取方法的特点是按如下步骤进行:
步骤1、对所需要标定的机器人建立运动学模型,记为p=f(x,y),其中x表示机器人的驱动关节的变化参数,y表示机器人结构的运动学参数,p表示机器人末端动平台在工作空间中所对应的位姿;
步骤2、根据机器人的运动学模型p,利用式(1)求解运动学参数误差的雅可比矩阵j:
采用奇异值分解法对雅可比矩阵j进行分解,得到j=u∑v,并有:
其中,σi表雅可比矩阵j的奇异值,且σ1≥σ2…≥σl≥0;则σl表示最小的奇异值,σ1表示最大奇异值;
利用式(2)得到参数辨识雅可比矩阵能观指数o,并作为为优化指标:
式(2)中,n表示需要辨识的运动学参数的数目;
步骤3、随机采集位姿并迭代优化;
步骤3.1、在机器人末端动平台的工作空间中随机选择一组nm个标定测量的位姿作为初始位姿,记作
步骤3.2、如果当前迭代次数n′i≥ni,跳出当前迭代循环过程,输出优化后的位姿集
步骤3.3、将
步骤3.4、调用步骤5,剔除η+中的冗余位置
步骤4、利用禁忌优化算法优化选取机器人末端动平台的位姿
步骤4.1、初始化禁忌列表长度为l,领域解个数为k,可行解集
令当前最优解值
步骤4.2、如果当前迭代次数in′i≥ini,则跳出当前循环,将
式(3)中,
如果
则有
如果
则有
步骤4.3、将步骤4.2产生的所有k个领域解与可行解集进行合并,并将
步骤4.3.1、如果当前可行解集
步骤4.3.2、对所取出的领域解
步骤4.3.3、如果更新后的禁忌列表集tl的长度大于l,则将禁忌列表清空,即
步骤4.4、如果当前最优解集
步骤5、剔除解集中的冗余位姿;
步骤5.1、调用步骤3产生的位姿解集η+,初始化最大迭代次数rni=nm+1,当前迭代次数为rn′i=1;能观指数列表为
步骤5.2、如果当前迭代次数rn′i≥nm+1,则跳出当前循环,输出冗余位置η-;否则,从位姿解集η+中取一个位姿
步骤5.3、如果当前能观指数
步骤5.4、将rn′i+1赋值给rn′i,并返回步骤5.2。
与已有技术相比,本发明的有益效果体现在:
1、本发明采用运动学参数误差雅可比矩阵的能观指数作为优化指标并在机器人工作空间中全局选取位姿点,利用全局优化算法对选择的位姿点进行优化,使得优化指标最优,最后剔除优化位姿解集中的冗余解,从而保证了迭代优化后的解集最优,减少测量位姿点的数目,提高辨识速度和辨识结果的鲁棒性;
2、本发明采用运动学参数误差雅可比矩阵的能观指数作为优化指标,选择位姿使得优化指标最优,提高了辨识结果的鲁棒性和精度;
3、本发明采用全局优化算法,在机器人工作空间中全局选取优化位姿,解决了传统优化算法的不足,降低了算法的计算量,提高了算法效率;
4、本发明选取优化的位姿用于标定机器人的运动学参数误差,可以使得测量位姿点的数目最小,同时保证了辨识结果的鲁棒性和精度,大大提高了标定速度和生产效率。
具体实施方式
本实施例中,一种新型参数标定位姿选取系统,是用于机器人运动学参数误差标定中,优化选取测量位姿,使得参数雅可比矩阵的能观指数最优。在参数标定位置选取系统中设置有随机位姿采集模块,智能优化算法位姿优化选取姿态,冗余位姿剔除模块。
参数标定随机位置姿态采集模块采用迭代优化的方法,在机器人的工作空间中随机采集一组用于标定测的位置姿态集;将生成的随机测量位置姿态迭代传给禁忌优化算法模块,并将优化选取后的测量位置姿态设置在一组待测量的位置姿态集中,从而得到优化后的位置姿态集。
禁忌优化算法模块用于优化采集的位置姿态集,使得辨识参数雅可比矩阵的能观指数参数最优。
冗余位置姿态剔除模块用于对优化选取的位置姿态集中剔除冗余的位置姿态,保证测量的位置姿态集中的所有位置姿态都是最优。
本实施例中,一种机器人运动学参数标定位姿优化选取方法,是按如下步骤进行:
步骤1、对所需要标定的机器人建立运动学模型,记为p=f(x,y),其中x表示机器人的驱动关节的变化参数,y表示机器人结构的运动学参数,p表示机器人末端动平台在工作空间中所对应的位姿;机器人结构的运动学参数一般是指机器人结构的尺寸参数,电机与减速机的减速比,末端动平台相对机器人的参考关系。这些参数的辨识精度主要受标定选用的位姿点的影响,所以在辨识前选定最优的测量位姿点。
步骤2、根据机器人的运动学模型p,利用式(1)求解运动学参数误差的雅可比矩阵j:
采用奇异值分解法对雅可比矩阵j进行分解,得到j=u∑v,并有:
其中,σi表雅可比矩阵j的奇异值,且σ1≥σ2…≥σl≥0;则σl表示最小的奇异值,σ1表示最大奇异值;
利用式(2)得到参数辨识雅可比矩阵能观指数o,并作为为优化指标:
式(2)中,n表示需要辨识的运动学参数的数目,根据实际标定需要来确定;
步骤3、随机采集位姿并迭代优化;
步骤3.1、在机器人末端动平台的工作空间中随机选择一组nm个标定测量的位姿作为初始位姿,记作
步骤3.2、如果当前迭代次数n′i≥ni,跳出当前迭代循环过程,输出优化后的位姿集
步骤3.3、将
步骤3.4、调用步骤5,剔除η+中的冗余位置
步骤4、利用禁忌优化算法优化选取机器人末端动平台的位姿
步骤4.1、初始化禁忌列表长度为l,取值l=2nm,领域解个数为k,取值k=4nm可行解集
令当前最优解值
步骤4.2、如果当前迭代次数in′i≥ini,则跳出当前循环,将
式(3)中,
如果
则有
如果
则有
步骤4.3、将步骤4.2产生的所有k个领域解与可行解集进行合并,并将
步骤4.3.1、如果当前可行解集
步骤4.3.2、对所取出的领域解
步骤4.3.3、如果更新后的禁忌列表集tl的长度大于l,则将禁忌列表清空,即
步骤4.4、如果当前最优解集
步骤5、剔除解集中的冗余位姿;
步骤5.1、调用步骤3产生的位姿解集η+,初始化最大迭代次数rni=nm+1,当前迭代次数为rn′i=1;能观指数列表为
步骤5.2、如果当前迭代次数rn′i≥nm+1,则跳出当前循环,输出冗余位置η-;否则,从位姿解集η+中取一个位姿
步骤5.3、如果当前能观指数
步骤5.4、将rn′i+1赋值给rn′i,并返回步骤5.2。
在算法优化过程中总是随机产生位姿点以及总是使得优化到使得能观指数最优,所以算法在概率上完备有效,总是能够收敛到最优的位姿点。算法的收敛时间随着迭代次数和需要辨识参数个数,以及需要测量的位姿点数的增大而增大,不过总是能够收敛到最优的一组位姿解集。