一种冗余机器人运动灵活性能综合评价与优化方法
【专利摘要】本发明一个具有冗余关节的铺丝机器人，采用旋量的理论建立其运动学雅可比矩阵，为了综合评价其灵活性能指标，将条件数、可操作度、最小奇异值三个指标进行变化后建模为三个目标函数，采用一种改进的多目标遗传算法并引入Pareto效率对它们进行优化。将优化后的Pareto第一前端最优解集进行数据分析，采用相关系数描述了指标间关系，发现对铺丝机器人进行性能优化时，必需要考虑指标间的相互关系，最后获得了综合性能最优的铺丝机器人工作空间区域。通过仿真结果证明了采用帕累托效率进行多目标函数的遗传算法优化和应用是可靠和高效的，为铺丝机器人的下一步试验研究奠定了基础，同时对于其他串联机器人的运动灵活性性能的分析和优化提供了良好的参考价值。
【专利说明】
-种冗余机器人运动灵活性能综合评价与优化方法
技术领域
[0001] 本发明设及冗余机器人优化方法领域，特别是设及一种冗余机器人运动灵活性能 综合评价与优化方法。
【背景技术】
[0002] 对于一定构型的机器人，其灵活性的好坏会直接影响到具体操作任务能否完成， 因此衡量机器人运动灵活性的指标在机器人的设计、评价和运动规划中起着重要的作用。 各国学者为此展开了深入的研究并提出了许多机器人的灵活性指标，主要包括条件数、可 操作度、最小奇异值，并将运些指标应用于机器人的构型综合和轨迹规划，取得了良好的效 果。其中对于评价机器人灵活性在其工作空间上的整体状况，现有文献提出了反映机器人 灵活性在其整个工作空间上评价状况的全域性能指标，则运用性能指标对不同构型的串联 机器人进行了详细的性能指标分析，虽然采用数理统计的分析方法对机器人全域性能指标 做了深入的研究。但是在面对一个具体的任务空间时，特别是具有冗余关节的串联机器人 操作性能研究，考虑的不够，研究的对象W六自由度W下的机器人居多，运动灵活性指标的 综合优化研究也较少。
【发明内容】
[0003] 为了解决上述存在的问题，本发明提供一种冗余机器人运动灵活性能综合评价与 优化方法，建立一组灵活性能指标对冗余机器人进行综合优化和数学分析，寻求各种运动 灵活性能指标之间的相关性，为机器人灵活性能研究提供科学的参考依据提高更合理的优 化方法，为达此目的，本发明提供一种冗余机器人运动灵活性能综合评价与优化方法，其特 征在于：
[0004] 1)机器人雅可比矩阵的建立；
[0005] 利用运动旋量与POE公式[7]导出机器人雅可比矩阵的特征式（1):
[0006]
[0007]
[000引 W上各式中K/r表示相对惯性坐标系末端执行器的空间速度，为各个关节速度， 居(巧称为机器人空间速度的雅可比矩阵，其中Cl'与经刚体变换心的第i关 节的运动旋量Cl相对应，表示将第i个关节坐标系由初始位形变换到机器人的当前位形； [0009]根据单位运动旋量坐标的定义，与旋转关节对应的运动副旋量坐标为式(2): W10]
口 )；
[0011] r/1为当前位形下轴线上一点的位置矢量，CO^i为当前位形下旋转关节轴线方向的 单位矢量；
[0012] 宙公台族动关节对应的运动副旋量坐标为式(3):
[00。]
：(3>
[0014] /i为当前位形下移动关节轴线方向的单位矢量；
[0015] 针对屯自由度冗余铺丝机器人模型，参考坐标系{引取在第一个关节最左点处，建 立的雅而hk巧随町井M'l.
[0016] ):
[0017] 2)基于雅可比矩阵的机器人运动学灵活性能指标；
[0018] 根据矩阵理论定义如下几个经典的灵活性指标：
[0019] (1)条件数 k:
[0020] 条件数代表了雅可比转换矩阵向各个方向的变化均一性，其定义如下：
[0021]
[0022] 上式中，||*4||为矩阵為,的范数，通常取欧式范数，矩阵条件数的变换范围是i《k 《-，k越接近1，矩阵的性态越好，k越大，矩阵越趋于病态；
[0023] (2)可操作度W:
[0024] 可操作度反映了运动灵活性中的速度"大小"的含义，YosMkawa定义的可操作度 指标为：
[00 巧]
(7);
[00%] 可W证明，W = Ol化…Om。当机器人接近奇异位形时，雅可比矩阵的几个最小奇异值 接近零，W^O，即W越大，机器人的灵活性越好；
[0027] (3)最小奇异值Omin:
[0028] 雅可比矩阵最小奇异值Omin决定了实现给定末端速度F甚所需关节速度上限，即
自机器人接近奇异位形，〇。1。一0，对于给定的末端速度^"豆||^|一-因 此在机器人控制时，要保证雅可比矩阵最小奇异值Omin足够大；
[0029] 3)多目标优化方法；
[0030] (1)多目标优化模型的建立；
[0031] 多目标优化问题可W描述如下[引；
[003^ min.巧.、.) =[乂(.、-)，夫(妍 /or ￡?".、-eW。，（抑
[0033] 其中，X =[Xi，X2，…，XD]TG S，D为决策变量个数，S是D维决策空间；
[0034] 一组目标函数fi(x)，f2(x)，...，fM(x)将决策空间映射到目标空间，
M 为目标个数，Q是M维目标空间；
[0035] 4)多目标优化遗传算法；
[0036] 其算法流程如下：
[0037]输入:N(种群规模），MaxGen(最大遗传代数）；
[0038] 输出：Nds(非支配集）；
[0039] (1)初始化:产生初始化的种群Po，n = 0;
[0040] (2)遗传操作:使用2-竞标赛选择对Pn中的个体使用交叉和变异操作，产生的新的 个体进入Qn,其规模等于N ;
[0041 ] (3)合并操作:将Pn和Qn合并产生Rn;
[0042] (4)非劣分类操作:对具有2N规模的种群Rn进行非劣分类操作。将Rn中的所有非支 配个体拷入非支配集Nds,如果Nds的规模超过N，计算个体的拥挤距离，选择拥挤距离大的 个体优先进入Pn+1，直到规模等于N;如果其规模小于或者等于N，拷贝Nds中的个体进入Pn+1， 规模不够N的部分，选择适应度高的支配个体进入Pn+1，直到其规模等于N;
[00创 （5)终止:如果n<MaxGen，n = n+l，跳转到第2步，否则，将Pn+冲的非支配个体作为 Nds输出。
[0044] 本发明一种冗余机器人运动灵活性能综合评价与优化方法，本发明可针对一个具 有冗余关节的铺丝机器人，采用旋量的理论建立其运动学雅可比矩阵，为了综合评价其灵 活性能指标，将条件数、可操作度、最小奇异值=个指标进行变化后建模为=个目标函数， 采用一种改进的多目标遗传算法并引入化reto效率对它们进行优化。将优化后的化reto第 一前端最优解集进行数据分析，采用相关系数描述了指标间关系，发现对铺丝机器人进行 性能优化时，必需要考虑指标间的相互关系，最后获得了综合性能最优的铺丝机器人工作 空间区域。通过仿真结果证明了采用帕累托效率进行多目标函数的遗传算法优化和应用是 可靠和高效的，为铺丝机器人的下一步试验研究奠定了基础，同时对于其他串联机器人的 运动灵活性性能的分析和优化提供了良好的参考价值。
【附图说明】
[0045] 图1为本发明算法流程图；
[0046] 图2为本发明多性能指标均衡分析曲面示意图；
[0047] 图3为本发明目标函数1和2的化reto第一前端最优解分布图；
[004引图4为本发明目标函数1和3的化reto第一前端最优解分布图；
[0049] 图5为本发明目标函数2和3的化reto第一前端最优解分布图；
[0050] 图6为本发明目标函数间的散点矩阵分布图；
[0051 ]图7为本发明目标函数间相关系数图；
[0052] 图8为本发明综合性能最优的机器人工作空间区域示意图；
【具体实施方式】
[0053] 下面结合附图与【具体实施方式】对本发明作进一步详细描述：
[0054] 本发明提供一种冗余机器人运动灵活性能综合评价与优化方法，建立一组灵活性 能指标对冗余机器人进行综合优化和数学分析，寻求各种运动灵活性能指标之间的相关 性，为机器人灵活性能研究提供科学的参考依据提高更合理的优化方法。
[0055] 作为本发明一种实施例，本发明提供一种冗余机器人运动灵活性能综合评价与优 化方法：
[0056] 1)机器人雅可比矩阵的建立；
[0057] 利用运动旋量与POE公式[7]导出机器人雅可比矩阵的特征式（1):
[0化引
[0化9] ?
[0060] W上各式中F品表示相对惯性坐标系末端执行器的空间速度，^为各个关节速度， ?4(巧称为机器人空间速度的雅可比矩阵，其中Cl'与经刚体变换/I;,/::=:.../一;-1的第i关 节的运动旋量Cl相对应，表示将第i个关节坐标系由初始位形变换到机器人的当前位形； [0061 ]根据单位运动旋量坐标的定义，与旋转关节对应的运动副旋量坐标为式(2):
[0062]
饼
[0063] 为当前位形下轴线上一点的位置矢量，为当前位形下旋转关节轴线方向的 单位矢量；
[0064] 定义与移动关节对应的运动副旋量坐标为式(3): 幽]
尚；
[0066] / 1为当前位形下移动关节轴线方向的单位矢量；
[0067] 针对屯自由度冗余铺丝机器人模型，参考坐标系{引取在第一个关节最左点处，建 立的雅可比矩阵见式(4):
[006引
[0069] 2)基于雅可比矩阵的机器人运动学灵活性能指标；
[0070] 机器人的雅克比矩阵实质上是机器人末端各运动分量与各关节运动的速度关系 矩阵。为了定量的描述机器人运动灵活性：
[0071 ]根据矩阵理论定义如下几个经典的灵活性指标：
[00巧 （1)条件数4:
[0073] 条件数代表了雅可比转换矩阵向各个方向的变化均一性，其定义如下：
[0074]
[00巧]上式中，!瑞I为矩阵?/宴的范数，通常取欧式范数，矩阵条件数的变换范围是l《k 《-，k越接近I，矩阵的性态越好，k越大，矩阵越趋于病态;在设计机器人机构和对机器人 进行控制时，要使雅可比矩阵尽量各向同性，即尽量"均匀"，就要控制雅可比矩阵的条件数 尽量接近1。
[0076] (2)可操作度W:
[0077] 可操作度反映了运动灵活性中的速度"大小"的含义，YosMkawa定义的可操作度 指标为：
[0078]
(7)；
[0079] 可W证明，W = Ol化…Om。当机器人接近奇异位形时，雅可比矩阵的几个最小奇异值 接近零，W^O，即W越大，机器人的灵活性越好；
[0080] (3)最小奇异值Omin:
[0081] 雅可比矩阵最小奇异值〇"1。决定了实现给定末端速度巧^所需关节速度上限；
[0082]
当机器人接近奇异位形，Omin^o,对于给定的末端速度，. I^l ^ <因此在机器人控制时，要保证雅可比矩阵最小奇异值Omin足够大；
[0083] 目前，采用综合几个灵活性指标对机器人运动灵活性进行性能评价较少，特别是 综合评价机器人在其工作空间内不同点不同区域的灵活性能，运对机器人的运动控制和优 化设计可W提供更好的参考准则。本申请尝试利用一种在机器人工作空间内建立能够同时 综合考虑多个灵活性能指标的优化模型，并寻找一种有效的求解方法，W获得具有较好综 合灵活性能的工作区域。
[0084] 3)多目标优化方法；
[0085] (1)多目标优化模型的建立；
[0086] 多目标优化问题可W描述如下[引；
[0087] 1 血巧句^乂林/:脚…'/山皆成广細尤巨嘴。，^);
[008引其中，X =[ Xl，X2，…，XD]T G S，D为决策变量个数，S是D维决策空间；
[0089] 一组目标函数fi(x)，f2(x)，…，fM(x)将决策空间映射到目标空间，5' e棘''M 为目标个数，Q是M维目标空间；
[0090] 4)多目标优化遗传算法；
[0091] 其算法流程如图1所示包括如下步骤：
[0092] 输入:N(种群规模），MaxGen(最大遗传代数）；
[0093] 输出：Nds(非支配集）；
[0094] (1)初始化:产生初始化的种群Po，n = 0;
[00M] (2)遗传操作:使用2-竞标赛选择对Pn中的个体使用交叉和变异操作，产生的新的 个体进入Qn,其规模等于N ;
[0096] (3)合并操作:将Pn和Qn合并产生Rn;
[0097] (4)非劣分类操作:对具有2N规模的种群Rn进行非劣分类操作。将Rn中的所有非支 配个体拷入非支配集Nds，如果Nds的规模超过N，计算个体的拥挤距离，选择拥挤距离大的 个体优先进入Pn+1，直到规模等于N;如果其规模小于或者等于N，拷贝Nds中的个体进入Pn+1， 规模不够N的部分，选择适应度高的支配个体进入Pn+1，直到其规模等于N;
[009引（5)终止:如果n<MaxGen，n = n+l，跳转到第2步，否则，将Pn+1中的非支配个体作为 Nds输出。
[0099] 本申请多指标优化仿真与分析；
[0100] 1)建立适应度函数；
[0101] 本文根据式(8)将最优化进行最小化问题求解，结合铺丝机器人的特点和几个常 用的灵活性能指标，W条件数k、可操作度W、最小奇异值Omin为基础建立分别反映机器人不 同的灵活性能的适应度函数f I(X) =k、f2 (X) = l/W、f3(X) = l/〇min。
[0102] 2目标函数的化reto最优解分布；
[0103] 将图1中的一种改进的多目标遗传算法对=个需优化的适应度函数'1^2^3，进行 化reto第一前端最优解分布的查找。种群中个体适应度值的计算，可根据表示当前作业点 位姿的个体的值进行运动学逆解计算得到对应此作业点的关节变量值。将关节变量值带入 雅可比矩阵进行计算，最后得到=个适应度函数的解集，通过=个适应度函数对种群 中个体质量进行综合评价，从而进行遗传优化。
[0104] 算法的参数设置如表1所示；
[0105]
[0106] 算法运行后得到400个化reto第一前端最优解，每个解代表了包含S个性能指标 的一组取值。将整个最优前端解集拟合成一个曲面，如图2所示，可W进行铺丝机器人=个 灵活性能指标的均衡分析，通过曲面找到合适的解集。
[0107] 同时，也可W得到指标1和2、指标1和3、指标2和3的化reto第一前端最优解分布， 如图3、4、5所示，从中可W看出，所得最优解集在化re to前端分布均匀，具有良好的收敛性。
[0108] 图6是目标函数之间表示相关性的散点矩阵，对角中的元素表示每个目标函数的 概率密度图，对角W外的元素表示目标函数之间的相关性散点图，通过散点矩阵图可W直 观地观察出不同指标之间的关系变化。
[0109] 将相关性散点图的数据进行处理，可W得到它们之间的相关系数矩阵，如图7所 示。从中我们发现指标1与指标2、3之间分别是高度的负相关和高度正相关，而指标2与指标 3之间是显著负相关，运表明=个性能指标条件数、可操作度、最小奇异值之间是相互影响 的，如果过度追求一个性能指标的最优会影响到其它指标的性能，运说明了多个性能指标 参与机器人运动灵活性能优化的必要性。
[0110] 优化机器人的目的是希望铺丝机器人在工作中发挥更好的灵活性，根据W上=个 性能指标的均衡最优解集，我们可W得到铺丝机器人工作空间综合性能最优的操作区域， 如图8所示，在运个区域中机器人对其工作对象忍模操作可W获得良好的性能。
[0111] W上所述，仅是本发明的较佳实施例而已，并非是对本发明作任何其他形式的限 审IJ，而依据本发明的技术实质所作的任何修改或等同变化，仍属于本发明所要求保护的范 围。
【主权项】
1. 一种冗余机器人运动灵活性能综合评价与优化方法，其特征在于： 1) 机器人雅可比矩阵的建立； 利用运动旋量与POE公式[7]导出机器人雅可比矩阵的特征式（1): ?， 以上各式中^表示相对惯性坐标系末端执行器的空间速度，?为各个关节速度，人 称为机器人空间速度的雅可比矩阵，其中与经刚体变换.../μ%的第i关节的运 动旋量L相对应，表示将第i个关节坐标系由初始位形变换到机器人的当前位形； 根据单位运动旋量坐标的定义，与旋转关节对应的运动副旋量坐标为式(2): 一(2); 为当前位形下轴线上一点的位置矢量，为当前位形下旋转关节轴线方向的单位 矢量； 定义与移动关节对应的运动副旋量坐标为式(3):(3)； ν'为当前位形下移动关节轴线方向的单位矢量； 针对七自由度冗余铺丝机器人模型，参考坐标系{S}取在第一个关节最左点处，建立的 雅可比矩阵见式(4) ~」ν·~*ν， 2) 基于雅可比矩阵的机器人运动学灵活性能指标； 根据矩阵理论定义如下几个经典的灵活性指标： (1) 条件数k: 条件数代表了雅可比转换矩阵向各个方向的变化均一性，其定义如下：上式中，lk&||为矩阵·/&的范数，通常取欧式范数，矩阵条件数的变换范围是 k越接近1，矩阵的性态越好，k越大，矩阵越趋于病态； (2) 可操作度W: 可操作度反映了运动灵活性中的速度"大小"的含义，Yoshikawa定义的可操作度指标 为：可以证明，w=〇1〇2…(?，当机器人接近奇异位形时，雅可比矩阵的几个最小奇异值接近 零，W-0，即W越大，机器人的灵活性越好； (3)最小奇异值〇min: 雅可比矩阵最小奇异值〇min决定了实现给定末端速度.所需关节速度上限，Bf 当机器人接近奇异位形，〇min-0,对于给定的末端速度K/r， ，. PI -00因此在机器人控制时，要保证雅可比矩阵最小奇异值够大； 3) 多目标优化方法； (1)多目标优化模型的建立； 多目标优化问题可以描述如下[8];其中，X = [X1，X2，…，XD]Te S，D为决策变量个数，S是D维决策空间； 一组目标函数fi(x)，f2(x)，···，fM(x)将决策空间映射到目标空间，S ，M为目 标个数，Ω是Μ维目标空间； 4) 多目标优化遗传算法； 其算法流程如下： 输入:Ν(种群规模），MaxGen(最大遗传代数）； 输出:Nds(非支配集）； (1) 初始化:产生初始化的种群Ρο，η = 0; (2) 遗传操作:使用2-竞标赛选择对Ρη*的个体使用交叉和变异操作，产生的新的个体 进入Qn，其规模等于Ν; (3) 合并操作:将P4PQn^并产生Rn; (4) 非劣分类操作:对具有2N规模的种群Rn进行非劣分类操作，将Rn中的所有非支配个 体拷入非支配集Nds，如果Nds的规模超过N，计算个体的拥挤距离，选择拥挤距离大的个体 优先进入P n+1，直到规模等于N;如果其规模小于或者等于N，拷贝Nds中的个体进入Pn+1，规模 不够N的部分，选择适应度高的支配个体进入P n+1，直到其规模等于N; (5) 终止:如果n〈MaxGen，n = n+l，跳转到第2步，否则，将Ρη+ι中的非支配个体作为Nds输 出。
【文档编号】G06N3/12GK105956297SQ201610302190
【公开日】2016年9月21日
【申请日】2016年5月9日
【发明人】应明峰, 莫晓晖, 李晓晖, 杭阿芳, 周洪, 高峰, 赵国树
【申请人】金陵科技学院