专利名称:三自由度搬运工业机器人多目标优化设计参数的获取方法
技术领域:
本发明涉及一种搬运工业机器人设计参数的获取方法,尤其涉及一种三自由度搬运工业机器人多目标优化设计参数的获取方法。
背景技术:
工业机器人是一种典型的复杂系统,对于一个复杂系统的设计优化而言,其主要特点为由于复杂工程系统通常包含若干个具有特定功能的子系统,系统和子系统都有各自相应的设计目标、设计参数和约束条件,同时又由于子系统之间存在复杂的耦合关系,因此复杂工程系统的设计过程已经成为一个多学科交叉综合设计的多目标优化决策过程。由最优组件和子系统组成的大系统,并不一定是整体性能最优的系统。因此,复杂工程系统的设计过程需要能够兼顾不同因素之间复杂耦合关系的优化理论与方法的支持。
在工业机器人的设计中,机械系统设计影响传动系统、控制系统的设计,传动系统设计影响控制系统的设计,同时,控制系统设计又影响机械系统和传动系统设计。但是,在传统工业机器人设计流程中,机械系统、传动系统、控制系统的设计依次单独进行,因而上游子系统设计无法兼顾下游子系统设计的设计指标,下游子系统设计也无法兼顾上游子系统设计的设计指标,从而影响了系统整体性能的提高。
发明内容
本发明提供一种能够实现并行优化的三自由度搬运工业机器人多目标优化设计参数的获取方法。
本发明采用如下技术方案 步骤1建立机械臂运动学模型、强度分析模型、基于机电耦合系统动力学模型及逆动力学控制的系统闭环模型,并使用机械臂运动学模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的工作空间性能指标 J1=λ1Rmin-λ2Rmax=f1(l2,l3), 其中,Rmin为工作空间最小半径,Rmax为工作空间最大半径,λ1、λ2分别为最小半径与最大半径的权系数,l2为第二机械臂的臂长,l3为第三机械臂的臂长; 使用强度分析模型获得涉及第二机械臂(2)及第三机械臂(3)的综合强度性能指标 其中,[σ]为第二机械臂(2)及第三机械臂(3)所用材料的许用弯曲应力;σ2max、σ3max分别表示在机器人运动过程中,第二机械臂(2)及第三机械臂(3)上的最大应力;|σ2max-0.8[σ]|、|σ3max-0.8[σ]|分别表示机器人运动过程中,第二机械臂(2)及第三机械臂(3)上的最大应力与材料许用弯曲应力的0.8倍的接近程度,l1为第一机械臂的臂长,b2、h2为第二机械臂(2)外截面的宽度及高度,b2e、h2e为第二机械臂(2)内腔的宽度及高度,b3、h3为第三机械臂(3)外截面的宽度及高度,b3e、h3e为第三机械臂(3)内腔的宽度及高度,
分别为第二关节、第三关节的最大角加速度,
分别为第一关节、第二关节、第三关节的最大角速度,7×107为比例系数; 使用系统闭环模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的平均控制能量指标 及平均控制时间指标 其中,200是指在给定设计要求的工作空间中随机选取400个点作为搬运任务的起止点,由此组成200组搬运任务工作点;n表示第n组搬运任务,mLn表示第n组搬运任务的负载质量,|θ1n|、|θ2n|、|θ3n|分别表示表示完成第n组搬运任务第一关节、第二关节及第三关节的转动角度,τ1(t)、τ2(t)、τ3(t)分别表示完成第n组搬运任务第一关节、第二关节及第三关节在t时刻输出的电磁转矩,tfn表示完成第n组搬运任务的完成时间,R1、r1分别为圆筒形的第一机械臂(1)外半径及内半径,
为第一关节的最大角加速度; 步骤2对工作空间性能指标、综合强度性能指标、平均控制能量指标及平均控制时间指标涉及的参数进行选择性优化,并建立多目标并行优化模型 首先,选择参数l2、l3、b2、h2、b3、h3、
作为设计变量,对 工作空间性能指标 J1=λ1Rmin-λ2Rmax, 综合强度性能指标 J2=|σ2Zmax-0.8[σ]|+|σ3Zmax-0.8[σ]|, 平均控制能量指标 及平均控制时间指标 进行同时优化,得到多目标优化设计任务 其中,x1是由设计变量l2、l3组成的向量,称之为臂长设计向量,其中,
的下标1表示设计向量x1,上标1表示设计向量x1的第一分量,
的下标1表示设计向量x1,上标2表示设计向量x1的第二分量;x2是由设计变量b2、h2、b3、h3组成的向量,称之为臂的厚度设计向量,其中,
的下标2表示设计向量x2,上标1表示设计向量x2的第一分量,
的下标2表示设计向量x2,上标2表示设计向量x2的第二分量,
的下标2表示设计向量x2,上标3表示设计向量x2的第三分量,
的下标2表示设计向量x2,上标4表示设计向量x2的第四分量;x3是由设计变量组成的向量,称之为关节的运动学能力设计向量,
的下标3表示设计向量x3,上标1表示设计向量x3的第一分量,
的下标3表示设计向量x3,上标2表示设计向量x3的第二分量,
的下标3表示设计向量x3,上标3表示设计向量x3的第三分量,
的下标3表示设计向量x3,上标4表示设计向量x3的第四分量,
的下标3表示设计向量x3,上标5表示设计向量x3的第五分量,
的下标3表示设计向量x3,上标6表示设计向量x3的第六分量;φ1为第一约束条件向量,φ1=[(l2—l3)—dmin,dmax—(l2+l3),l3—l2,—l2,—l3]T,这里,dmin=0.2,dmax=1.5,分别代表对所设计的机械臂工作空间最小半径与最大半径的设计要求,其值根据具体的设计需要进行调整;φ2为第二约束条件向量,φ2=[h2e-h2,b2e-b2,h3e-h3,b3e-b3]T;φ3为第三约束条件向量 其次,将约束条件与工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4进行合并转化,得到广义工作空间性能指标Z1,广义综合强度性能指标Z2,广义平均控制能量指标Z3及广义平均控制时间指标Z4 其中,
分别是工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4的期望值,
分别表示第一约束条件向量的第m个元素、第二约束条件向量的第m个元素、第三约束条件向量的第m个元素;σ1为第一罚系数,σ1=1000;σ2为第二罚系数,σ2=1000;σ3为第三罚系数,σ3=1000; 步骤3用控制方法获得多目标优化设计参数 建立第一控制律 其中,v1,i为第i次迭代时臂长设计向量x1的调整量,
的第一下标1和上标1表示该调整量是对设计向量x1中的第一设计变量
的调整量,第二下标i表示迭代次数,
的第一下标1和上标2表示该调整量是对设计向量x1中的第二设计变量
的调整量,第二下标i表示迭代次数; 对第一控制律产生的调整量v1,i的调整幅度进行修正 如果 如果 其中,
表示设计向量x1的第一设计分量
第i—1次迭代后的设计值,
表示设计向量x1的第二设计分量
第i—1次迭代后的设计值; 用修正后的调整值v1,i调整臂长设计向量x1,得到第i次迭代后设计向量x1的值x1,i=x1,i-1+v1,i;e1,i-1为广义工作空间性能指标Z1在第i—1次迭代后的值Z1,i-1与目标值0的误差,e1,i-1=0—Z1,i-1; e2,i-1为广义综合强度性能指标Z2在第i—1次迭代后的值Z2,i-1与目标值0的误差,e2,i-1=0—Z2,i-1; e3,i-1为广义平均控制能量指标Z3在第i—1次迭代后的值Z3,i-1与目标值0的误差,e3,i-1=0—Z3,i-1; e4,i-1为广义平均控制时间指标Z4在第i—1次迭代后的值Z4,i-1与目标值0的误差,e4,i-1=0—Z4,i-1;
为误差值e1,i-1相对于设计向量值x1,i-1的负导数对应的符号向量,
的上标1表示广义工作空间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义工作空间性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e2,i-1相对于设计向量值x1,i-1的负导数对应的符号向量,
的上标2表示广义综合强度性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义综合强度性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x1,i-1的偏导数的符号向量,
的上标3表示广义平均控制能量指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义平均控制能量性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e4,i-1相对于设计向量值x1,i-1的偏导数的符号向量,
的上标4表示广义平均控制时间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义平均控制时间指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e1,i-1在控制律1中的比例系数,
上标1表示广义工作空间性能指标的误差,下标1表示控制律1,并且令
为误差值e2,i-1在控制律1中的比例系数,
上标2表示广义综合强度性能指标的误差,下标1表示控制律1,并且令
为误差值e3,i-1在控制律1中的比例系数,
上标3表示广义平均控制能量性能指标的误差,下标1表示控制律1,并且令
为误差值e4,i-1在控制律1中的比例系数,
上标4表示广义平均控制时间性能指标的误差,下标1表示控制律1,并且令 建立第二控制律 其中,v2,i为第i次迭代时臂厚设计向量x2的调整量,
的第一下标2和上标1表示该调整量是对设计向量x2中的第一设计分量
的调整量,第二下标i表示迭代次数,
的第一下标2和上标2表示该调整量是对设计向量x2中的第二设计分量
的调整量,第二下标i表示迭代次数,
的第一下标2和上标3表示该调整量是对设计向量x2中的第三设计分量
的调整量,第二下标i表示迭代次数,
的第一下标2和上标4表示该调整量是对设计向量x2中的第四设计分量
的调整量,第二下标i表示迭代次数; 对第二控制律产生的调整量v2,i的调整幅度进行修正 如果 如果 其中,
表示设计向量x2的第一设计分量
第i—1次迭代后的设计值,
表示设计向量x2的第二设计分量
第i—1次迭代后的设计值,
表示设计向量x2的第三设计分量
第i—1次迭代后的设计值,
表示设计向量x2的第四设计分量
第i—1次迭代后的设计值; 用修正后的调整值v2,i调整臂厚设计向量,得到第i次迭代后设计向量x2的值x2,i=x2,i-1+v2,i;
为误差值e2,i-1相对于设计向量值x2,i-1的负导数对应的符号向量,
的上标2表示广义综合强度性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
时广义综合强度性能指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x2,i-1的偏导数的符号向量,
的上标3表示广义平均控制能量性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
时广义平均控制能量指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
为误差e2,i-1在控制律2中的比例系数,
上标2表示广义综合强度性能指标的误差,下标2表示控制律2,并且令
为误差e3,i-1在控制律2中的比例系数,
上标3表示广义平均控制能量性能指标的误差,下标2表示控制律1,并且令 建立第三控制律 其中,v3,i为第i次迭代时关节运动学能力设计向量x3的调整量,
的第一下标3和上标1表示该调整量是对设计向量x3中的第一设计分量
的调整量,第二下标i表示迭代次数,
的第一下标3和上标2表示该调整量是对设计向量x3中的第二个设计分量
的调整量,第二下标i表示迭代次数,
的第一下标3和上标3表示该调整量是对设计向量x3中的第三设计分量
的调整量,第二下标i表示迭代次数,
的第一下标3和上标4表示该调整量是对设计向量x3中的第四设计分量
的调整量,第二下标i表示迭代次数;
的第一下标3和上标5表示该调整量是对设计向量x3中的第五设计分量
的调整量,第二下标i表示迭代次数;
的第一下标3和上标6表示该调整量是对设计向量x3中的第六设计分量
的调整量,第二下标i表示迭代次数; 对第三控制律产生的调整量v3,i的调整幅度进行修正 如果 如果 其中,
表示设计向量x3的第一设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第二设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第三设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第四设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第五设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第六设计分量
第i—1次迭代后的设计值; 用修正后的调整量v3,i调整关节的运动学能力设计向量x3,计算第i次迭代后设计向量x3的值x3,i=x3,i-1+v3,i;
为误差值e2,i-1相对于设计向量值x3,i-1的负导数对应的符号向量,
的上标2表示广义综合强度性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
时广义综合强度性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x3,i-1的偏导数的符号向量,
的上标3表示广义平均控制能量性能指标的误差,第一下标3表示运动学能力设计向量,第二下标i—1表示在计算
时广义平均控制能量性能指标的误差值及运动学能力向量的值为第i—1次迭代后的值;
为误差值e4,i-1相对于设计向量值x3,i-1的偏导数的符号向量,
的上标4表示广义平均控制时间性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
时广义平均控制时间性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
为误差值e2,i-1在控制律3中的比例系数,
上标2表示广义综合强度性能指标的误差,下标3表示控制律3,并且令
为误差值e3,i-1在控制律3中的比例系数,
上标3表示广义平均控制能量性能指标的误差,下标3表示控制律3,并且令
为误差值e4,i-1在控制律4中的比例系数,
上标4表示广义平均控制时间性能指标的误差,下标4表示控制律4,并且令 利用第一控制律、第二控制律、第三控制律对臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3进行第一次优化设计 为臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3赋初始设计值,得到向量x1,0、向量x2,0、向量x3,0; 为各性能指标期望值
赋第一次多目标优化设计的参考值
得到对于
其第一下标1表示工作空间性能表,第二下标1表示第一次多目标优化设计,对于
其第一下标2表示综合强度性能指标,第二下标1表示第一次多目标优化设计,对于
其第一下标3表示平均控制能量指标,第二下标1表示第一次多目标优化设计,对于
其第一下标4表示平均控制时间指标,第二下标1表示第一次多目标优化设计; 由第一次多目标优化设计的参考值
及x1,0、x2,0、x3,0计算得到各广义性能指标的初始值Z1,0、Z2,0、Z3,0、Z4,0;如果Z1,0、Z2,0、Z3,0、Z4,0不全部为零,则进入步骤3.1;如果Z1,0、Z2,0、Z3,0、Z4,0全部为零,则设计向量x1、x2、x3的初始值x1,0、x2,0、x3,0即为多目标优化设计参数的值; 步骤3.1对设计变量组成的向量x1、x2、x3进行第一次迭代,迭代次数i=1 首先,由第一控制律及对第一控制律产生的调整量v1,1幅度修正方法 如果 如果 生成对向量x1的第一次迭代的调整值v1,1,再用调整值v1,1调整向量x1,得到向量x1第一次迭代后的值x1,1=x1,0+v1,1;这里,e1,0为广义工作空间性能指标在初始时刻的值Z1,0与目标值0的误差,e1,0=0—Z1,0;e2,0为广义综合强度性能指标在初始时刻的值Z2,0与目标值0的误差,e2,0=0—Z2,0;e3,0为广义平均控制能量指标在初始时刻的值Z3,0与目标值0的误差,e3,0=0—Z2,0;e4,0为广义平均控制时间指标在初始时刻的值Z4,0与目标值0的误差,e4,0=0—Z4,0;
为误差值e1,0相对于设计向量值x1,0的负导数对应的符号向量,
为误差值e2,0相对于设计向量值x1,0的负偏导数对应的符号向量,
为误差值e3,0相对于设计向量值x1,0的负偏导数对应的符号向量,
为误差值e4,0相对于设计向量值x1,0的负偏导数对应的符号向量, 其次,由第二控制律及对第二控制律产生的调整量v2,1的幅度修正方法 如果 如果 生成对臂厚设计向量x2的第一次迭代的调整值v2,1,用调整值v2,1调整臂厚设计向量x2,得到向量x2的第一次迭代后的值x2,1=x2,0+v2,1;这里,
为误差值e2,0相对于设计向量值x2,0的负偏导数对应的符号向量,
为误差值e3,0相对于设计向量值x2,0的负偏导数对应的符号向量, 再次,由第三控制律及对第三控制律产生的调整量v3,1的幅度修正方法 如果 如果 生成对关节运动学能力设计向量x3的第一次调整值v3,1,用调整值v3,1调整关节运动学能力设计向量x3,得到设计向量x3的第一次迭代后的值x3,1=x3,0+v3,1;这里,
为误差值e2,0相对于x3,0的负偏导数对应的符号向量,
为误差值e3,0相对于设计向量值x3,0的负偏导数对应的符号向量,
为误差值e4,0相对于设计向量值x3,0的负偏导数对应的符号向量, 最后,在得到设计向量x1、x2、x3的第一次迭代后的向量值x1,1、x2,1、x3,1之后,计算第一次调整后各广义性能的值Z1,1、Z2,1、Z3,1、Z4,1,如果Z1,1、Z2,1、Z3,1、Z4,1不全部为零,则进入步骤3.2;如果Z1,1、Z2,1、Z3,1、Z4,1全部为零,则所得到的向量x1、x2、x3的第一次迭代的值x1,1、x2,1、x3,1为多目标优化设计参数; 步骤3.2对设计变量组成的向量x1、x2、x3进行第二次迭代,迭代次数i=2首先,由第一控制律及对第一控制律产生的调整量v1,2幅度修正方法 如果 如果 生成对向量x1的第二次迭代的调整值v1,2,再用调整值v1,2调整向量x2,得到第二次迭代后设计向量x1的值x1,2=x1,1+v1,2;这里,e1,1为广义工作空间性能指标在第一次迭代后的值Z1,1与目标值0的误差,e1,1=0—Z1,1;e2,1为广义综合强度性能指标在第一次迭代后的值Z2,1与目标值0的误差,e2,1=0—Z2,1;e3,1为广义平均控制能量性能指标在第一次迭代后的值Z3,1与目标值0的误差,e3,1=0—Z3,1;e4,1为广义平均控制能量性能指标在第一次迭代后的值Z4,1与目标值0的误差,e4,1=0—Z4,1;
为误差值e1,1相对于设计向量值x1,1的负导数对应的符号向量,
为误差值e2,1相对于设计向量值x1,1的负偏导数对应的符号向量,
为误差值e3,1相对于设计向量值x1,1的负偏导数对应的符号向量,
为误差值e4,1相对于设计向量值x1,1的负偏导数对应的符号向量, 其次,由第二控制律及对第二控制律产生的调整量v2,2的幅度修正方法 如果 如果 生成设计向量x2进行第二次迭代的调整值再用调整值v2,2调整设计向量x2的值,得到第二次迭代后设计向量x2的值x2,2=x2,1+v2,2;这里,
为误差值e2,1相对于设计向量值x2,1的负偏导数对应的符号向量,
为误差值e3,1相对于设计向量值x2,1的负偏导数对应的符号向量, 再次,由第三控制律及对第三控制律产生的调整量v3,2的幅度修正方法 如果 如果 生成设计向量x3的第二次迭代的调整值,再用调整值v3,2调整设计向量x3的值,得到第二次迭代后向量x3的值x3,2=x3,1+v3,2;这里,
为e2,1相对于设计向量值x3,1的负偏导数对应的符号向量,
为误差值e3,1相对于设计向量值x3,1的负偏导数对应的符号向量,
为误差值e4,1相对于设计向量值x3,1的负偏导数对应的符号向量, 最后,用得到的设计向量x1、x2、x3第二次迭代后的值x1,2、x2,2、x3,2,计算第二次迭代后各广义性能的值Z1,2、Z2,2、Z3,2、Z4,2,如果Z1,2、Z2,2、Z3,2、Z4,2不全部为零,则进入步骤3.3;如果Z1,2、Z2,2、Z3,2、Z4,2全部为零,则所得到的向量x1、x2、x3的第二次迭代的值x1,2、x2,2、x3,2即为多目标优化设计参数的值; 步骤3.3依此类推,通过第一控制律及对第一控制律产生的调整量幅度的修正方法,生成设计向量x1进行第j次迭代的调整值v1,j;通过第二控制律及对第二控制律产生的调整量幅度的修正方法,生成设计向量x2进行第j次迭代的调整值v2,j;通过第三控制律及对第三控制律产生的调整量幅度的修正方法,生成设计向量x3进行第j次迭代的调整值v3,j;重复上述迭代,如果在100次迭代内通过调整臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的值可以使广义工作空间性能指标Z1、广义综合强度性能指标Z2、广义平均控制能量指标Z3、广义平均控制时间指标Z4的值同时为零,则获得最终获得使各性能同时得到优化的臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的设计值;如果在100次迭代内无法使得广义工作空间性能指标Z1、广义综合强度性能指标Z2、广义平均控制能量指标Z3、广义平均控制时间指标Z4的值同时为零,则进入步骤3.4,直到各广义性能在100次迭代内使得广义性能指标Z1、Z2、Z3、Z4的值同时为零,获得最终获得使各性能同时得到优化的臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的最终设计值; 步骤3.4对各性能指标期望值
的期望值进行第n—1次调整后进行第n次优化设计,令n为优化设计的次数,对设计向量x1、x2、x3进行第n次优化设计,重复步骤3.1~步骤3.3。
与现有技术相比,本发明具有如下优点 1.本发明通过明确多目标优化设计任务将搬运机器人的机械系统设计、驱动系统设计由上下游设计关系转化为并行设计过程,从而兼顾了各子系统设计对机器人性能产生的影响,为全面优化机器人的工作空间性能、强度性能以及控制性能提供了方法。
2.通过将约束条件与优化目标进行合并转化,得到四个广义多目标优化指标 从而将多目标多目标优化目标转化为使四个广义性能指标同时趋于零。
3.针对转化后的多目标优化设计问题,提出了一种通过控制方法解决多目标优化问题的新方法。通过 第一控制律 第二控制律 第三控制律 分别建立臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3在第i次迭代的初始控制量。
4.通过建立控制律中误差系数的设置原则,实现控制律调整方向的协调。对于三个控制律,误差系数整定原则为 在第一控制律中,通过系数
的整定,保证在第i次迭代调整x1的设计值时,
对应的调整方向,即使Z1收敛至零的方向作为优先级最高的调整方向;第二级,
对应的调整方向,即使Z2收敛至零的方向作为优先级次高的调整方向;
对应的调整方向,即使Z3、Z4收敛至零的方向作为优先级最低的调整方向,对同处于最低优先级
对应的调整方向,规定
对应的调整方向优先级高于
对应的调整方向。
在第二控制律中,通过系数
的整定,保证在第i次迭代调整x2的设计值时,
对应的调整方向,即使Z2收敛至零的方向,作为优先级高的调整方向;
对应的调整方向,即使Z3收敛至零的方向,作为优先级低的调整方向。
在第三控制律中,通过系数
的整定,保证在第i次迭代调整x3的设计值时,
对应的调整方向,即使Z3、Z4收敛至零的方向作为高优先级的调整方向,对同处于高优先级
对应的调整方向,规定
对应的调整方向优先级高于
对应的调整方向;
对应的调整方向,即使Z2收敛至零的方向作为优先级低的调整方向。
同时规定,在第一控制律、第二控制律、第三控制律中优先级高的广义性能指标不收敛到零之前,相应的设计变量一直按照该广义性能指标收敛到零的方向调整。当优先级高的广义性能指标收敛到零之后,相应的设计变量按照优先级相对较高的广义性能指标收敛到零的方向调整,依次进行,直到所有广义性能指标都收敛到零。
5.通过设计对三个控制律生成的控制量幅度的调整方法,解决了用控制方法进行多目标优化设计时各广义性能指标的值不收敛到目标值零的问题。
用控制方法进行多目标优化设计时各广义性能指标的值不收敛到目标值零主要由于三种情况引起 原因一是对设计变量的调整量过大;原因二是对设计变量的调整量过小;原因三是由于对各性能指标的期望值设置不合理。针对原因一、原因二提出控制量幅度的调整方法。
为防止控制量幅度过大或过小提出 对于第一控制律生成的第i次迭代的调整量的幅度进行修正的方法为 如果 如果 对于第二控制律生成的第i次迭代的调整量的幅度进行修正的方法为 如果 如果 对于第三控制律,生成的第i次迭代的调整量的幅度进行修正的方法为 如果 如果 6.对三自由度搬运机器人的基本设计要求为该三自由度工业机器人的工作空间为以(0,0,1)为球心,最大半径Rmax=1.5,最小半径Rmin=0.2的两球之间的部分(单位m)。要求搬运的最大负载质量为25kg。在此基础上,要求工作空间最大化,强度满足材料要求,机械臂控制过程能量、时间性能最优。对于本设计任务,提给定预先设计参数的值分别为l1=1、R1=0.075、r1=0.05、h2e=0.08、b2e=0.08、h3e=0.08、b3e=0.08(单位m)。下面开始臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的设计。
首先,初始化各设计变量。
x1=
T,x2=
T,x3=[5,5,5,3,3,3]T。
计算初始化设计变量下机械臂各性能为 J1=—1.2,J2=1.3879,J3=1.6411,J4=0.4393。
结合机械臂初始性能,给定各性能最终优化的次最优指标 经过24次叠代,各性能都达到各性能可接受的性能值。优化前后各设计变量的变化以及性能指标的变化可通过表1及表2所示。
表1 优化设计前后设计变量设计值的变化 表2 优化设计前后各性能值的变化
图1是本发明的三自由度机器人及其连杆坐标系图。
图2是本发明获得多目标优化设计参数的控制方法框图。
图3是本发明设计实例2中广义性能指标1在设计过程中的变化情况图。
图4是本发明设计实例2中广义性能指标2在设计过程中的变化情况图。
图5是本发明设计实例2中广义性能指标3在设计过程中的变化情况图。
图6是本发明设计实例2中广义性能指标4在设计过程中的变化情况图。
图7是本发明的多目标优化设计步骤框图。
图8多目标优化设计步骤3的框图。
具体实施例方式 实施例1 1.一种三自由度搬运工业机器人多目标优化设计参数的获取方法,所述的三自由度搬运工业机器人包括第一机械臂(1)、第二机械臂(2)及第三机械臂(3),第二机械臂(2)的两端分别与第一机械臂(1)的一端、第三机械臂(3)的一端转动连接,其特征在于多目标优化设计参数的获取方法含有以下步骤 步骤1首先,建立该三自由度机械臂的连杆坐标系,如图1所示;由该机械臂运动学方程,可得末端工作点的轨迹为设各转角范围设计为-π≤θ1≤π,-π≤θ2≤π,-π≤θ3≤π则机械臂的工作空间是一簇以(0,0,l1)为球心,半径的同心球;设其中半径最小的球半径为Rmin,并规定l2≥l3,则Rmin=l2-l3;设半径最大球的半径为Rmax,则Rmax=l2+l3;则J1=λ1Rmin-λ2Rmax=(λ1-λ2)l2-(λ1+λ2)l3。
使用机械臂运动学模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的工作空间性能指标 J1=λ1Rmin-λ2Rmax=f1(l2,l3), 其中,Rmin为工作空间最小半径,Rmax为工作空间最大半径,λ1、λ2分别为最小半径与最大半径的权系数,l2为第二机械臂的臂长,l3为第三机械臂的臂长。
其次,通过以下五个步骤建立第二机械臂(2)及第三机械臂(3)的强度分析模型 第一,将第二机械臂(2)、第三机械臂(3)各自等分成K2、K3个单元,为了利用有限元模型分析第二机械臂(2)、第三机械臂(3)受力情况的精确性,K2、K3取值要求K2≥5000、K3≥5000; 第二,利用有限元模型,对第二机械臂(2)、第三机械臂(3)在机器人运动过程中由各单元所受惯性力组成的惯性力系分别在第三关节及第二关节处,即连杆坐标系中点o2、o1处进行简化。根据牵连运动为转动时点的加速度合成定理,可求得第二机械臂(2)、第三机械臂(3)各单元在机器人运动时的加速度其中
为单元i的绝对加速度,
为单元i的牵连加速度,
为单元i的相对加速度,
为单元i的科氏加速度,则惯性力系即为各单元在运动过程中产生的惯性力的综合作用,mi为单元i的质量,对于第二机械臂(2)各单元的惯性力系在第二关节处简化为主矢
主矩为
对于第三机械臂(3)各单元的惯性力系在第三关节处简化为主矢
主矩为
第三,根据对第二机械臂(2)、第三机械臂(3)在机器人运动过程中由各单元所受惯性力组成的惯性力系分别在第三关节及第二关节处简化得到的惯性力主矢与主矩以及质点系的达朗贝尔定理,分别求得关节3及关节2处产生的支反力及支反力偶; 第四,根据其次通过截面法求得机械臂2及3上各单元处的弯矩; 第五,经过分析可知,各机械臂关节处的单元在机械臂运动时产生的弯矩最大,并且机械臂2上关节2处单元的弯矩矢量在Z2轴分量最大,机械臂3上关节3处单元的弯矩矢量在Z3轴分量最大,分别设为M2Zmax及M3Zmax,并且经分析M3Zmax=τ3max、M2Zmax=τ2max;则机械臂运动时,第二机械臂(2)上最大应力第三机械臂(3)上的最大应力其中,τ2max、τ3max为运动时各关节驱动电机施加到机械臂上的最大转矩,W2Z、W3Z分别表示机械臂2与机械臂3的截面相对于连杆坐标系2的Z2轴及连杆坐标系3的Z3轴的抗弯截面系数;经计算可知对于τ2max、τ3ma,根据三自由度机器人机械部分的动力学方程可知 即关节施加到机械臂上的电磁转矩是关节位置、关节角速度、角加速度的值以及机器人的机械参数的非线性函数,而
的值,又取决于各关节电机能提供的最大角速度
及最大角加速度
的值(i=1,2,3),因此τ2、τ3是一个非线性有约束的多元函数,其最大值τ2max、τ3max的求解可以通过非线性函数约束条件下求极值的方法获得。
使用由上述五个步骤获得的强度分析模型得到涉及第二机械臂(2)及第三机械臂(3)的综合强度性能指标 其中,[σ]为第二机械臂(2)及第三机械臂(3)所用材料的许用弯曲应力;σ2max、σ3max分别表示在机器人运动过程中,第二机械臂(2)及第三机械臂(3)上的最大应力;|σ2max-0.8[σ]|、|σ3max-0.8[σ]|分别表示机器人运动过程中,第二机械臂(2)及第三机械臂(3)上的最大应力与材料许用弯曲应力的0.8倍的接近程度,l1为第一机械臂的臂长,b2、h2为第二机械臂(2)外截面的宽度及高度,b2e、h2e为第二机械臂(2)内腔的宽度及高度,b3、h3为第三机械臂(3)外截面的宽度及高度,b3e、h3e为第三机械臂(3)内腔的宽度及高度,
分别为第二关节、第三关节的最大角加速度,
分别为第一关节、第二关节、第三关节的最大角速度,7×107为比例系数。
最后,通过通过以下各步骤建立基于机电耦合系统动力学模型及逆动力学控制的系统闭环模型 第一,通过拉格朗日-欧拉法建立该机器人机械负载部分的动力学方程,其形式为 其中,Di、Dij、Dijk为机械部分动力学方程的系数,这些系数与机械设计参数及机械臂运动位置有关。τi为施加到机械臂i的机械部分的转矩,Iai为机械臂i传动装置的转动惯量,
θi分别为机械臂i所对应关节的瞬时角加速度、角速度及角位移,其中(i=1,2,3)。
在此基础上,设计该机器人机械系统与电机系统不经变速箱而直接连接,并将机械部分动力学模型折算到电机侧,建立起机电耦合系统的动力学模型 ;其中,umi为机械臂i控制电机的电枢电路电压;Ki为机械臂i的机械部分向电机部分折算的系数,Ki=Rmi/kmi,
为机械臂i的系统传动装置总转动惯量,Rmi、kmi、kei、Jmi分别为机械臂i对应控制电机的电枢电路电阻、转矩系数和电势系数和电机轴的转动惯量(i=1,2,3)。
第二,在机电耦合系统的动力学模型的基础上,采用具有偏置的PD控制律及逆动力学控制的策略,最终构成机器人控制系统,最终构成机器人闭环控制系统框图如图2所示,其中,Θd=[θd1,θd2,θd3]T,分别为参考轨迹向量、参考角速度及参考角加速度向量;KD=diag(kd1,kd2,kd3)、KP=diag(kp1,kp2,kp3),分别为控制器微分系数矩阵与比例系数矩阵。
第三,该机器人运动控制的参考轨线采用关节空间中抛物线过渡的线性插值法产生,并且使用机器人各关节的最大运动能力进行规划,以保证任何控制任务在机器人设计的运动能力内以最短的时间完成;各关节的最大运动能力与各关节驱动电机有关,包括各关节的最大角加速度
(单位rad/s2)以及各关节的最大角速度
(单位rad/s),在关节期望运动的匀加速运动阶段,各关节以
加速运动,至关节角速度达到
在关节期望运动的匀速运动阶段,各关节以
匀速运动;在关节期望运动的匀减速运动阶段,各关节以
减速运动,至关节角速度达到0;三段期望运动的结束时刻分别设为tai、tbi、tci,对于某些控制任务的期望运动也可能仅由匀加速与匀减速两段组成,该两端期望运动结束时间分别设为tai、tci。
第四,由于给定参考输入运动轨线在tai、tbi、tci时刻二阶导数不连续,实际控制轨线与参考轨线存在误差;由闭环控制系统模型可知误差函数为该误差函数是一个二阶微分方程,为使误差函数收敛,应通过控制器参数调整保证误差系统为过阻尼或临界阻尼状态,对于每个关节而言,即要求k2di≥4kpi,(i=1,2,3)。通过上述控制器参数下对闭环控制系统进行仿真可知,该误差在控制过程中完全可忽略不计; 第五,对于一项搬运任务其控制结束时间及所需控制能量的计算方法为设在基坐标系中搬运任务初始点坐标为(x0,y0,z0),终止点坐标为(xf,yf,zf),根据该机械臂逆运动学模型,计算完成该搬运任务各关节的初始关节角θi0终止关节角θif;根据上述参考轨迹的规划方案,生成各关节完成该搬运任务对应的参考角度轨线θdi(t)、参考角速度轨线
和参考角加速度轨线
并分别组成参考轨迹向量Θd(t)、参考角速度向量
及参考角加速度向量
根据具有偏置的PD控制律及逆动力学控制的策略的控制特点,可以认为控制结束时间即为三个关节参考轨迹结束时间,各关节控制过程中实际的角度、角速度、角加速度轨线即为参考角度、角速度、角加速度轨线;因此,该搬运任务的控制时间为tf=tc=max(tc1,tc2,tc3),该搬运任务的控制能量为其中τi(t)由机械臂机械部分动力学模型及控制任务对应的参考轨迹计算, 使用通过上述五个步骤获得的系统闭环模型得到第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的平均控制能量指标 及平均控制时间指标 其中,200是指在给定设计要求的工作空间中随机选取400个点作为搬运任务的起止点,由此组成200组搬运任务工作点;n表示第n组搬运任务,mLn表示第n组搬运任务的负载质量,|θ1n|、|θ2n|、|θ3n|分别表示表示完成第n组搬运任务第一关节、第二关节及第三关节的转动角度,τ1(t)、τ2(t)、τ3(t)分别表示完成第n组搬运任务第一关节、第二关节及第三关节在t时刻输出的电磁转矩,tfn表示完成第n组搬运任务的完成时间,R1、r1分别为圆筒形的第一机械臂(1)外半径及内半径,
为第一关节的最大角加速度; 步骤2对工作空间性能指标、综合强度性能指标、平均控制能量指标及平均控制时间指标涉及的参数进行选择性优化,并建立多目标并行优化模型 首先,选择参数l2、l3、b2、h2、b3、h3、
作为设计变量,对 工作空间性能指标 J1=λ1Rmin-λ2Rmax, 综合强度性能指标 J2=|σ2zmax-0.8[σ]|+|σ3Zmax-0.8[σ]|, 平均控制能量指标 及平均控制时间指标 进行同时优化,得到多目标优化设计任务 其中,x1是由设计变量l2、l3组成的向量,称之为臂长设计向量,其中,
的下标1表示设计向量x1,上标1表示设计向量x1的第一分量,
的下标1表示设计向量x1,上标2表示设计向量x1的第二分量;x2是由设计变量b2、h2、b3、h3组成的向量,称之为臂的厚度设计向量,其中,
的下标2表示设计向量x2,上标1表示设计向量x2的第一分量,
的下标2表示设计向量x2,上标2表示设计向量x2的第二分量,
的下标2表示设计向量x2,上标3表示设计向量x2的第三分量,
的下标2表示设计向量x2,上标4表示设计向量x2的第四分量;x3是由设计变量组成的向量,称之为关节的运动学能力设计向量,
的下标3表示设计向量x3,上标1表示设计向量x3的第一分量,
的下标3表示设计向量x3,上标2表示设计向量x3的第二分量,
的下标3表示设计向量x3,上标3表示设计向量x3的第三分量,
的下标3表示设计向量x3,上标4表示设计向量x3的第四分量,
的下标3表示设计向量x3,上标5表示设计向量x3的第五分量,
的下标3表示设计向量x3,上标6表示设计向量x3的第六分量;φ1为第一约束条件向量,φ1=[(l2—l3)—dmin,dmax—(l2+l3),l3—l2,—l2,—l3]T,这里,dmin=0.2,dmax=1.5,分别代表对所设计的机械臂工作空间最小半径与最大半径的设计要求,其值根据具体的设计需要进行调整;φ2为第二约束条件向量,φ2=[h2e-h2,b2e-b2,h3e-h3,b3e-b3]T;φ3为第三约束条件向量 其次,将约束条件与工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4进行合并转化,得到广义工作空间性能指标Z1,广义综合强度性能指标Z2,广义平均控制能量指标Z3及广义平均控制时间指标Z4 其中,
分别是工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4的期望值,
分别表示第一约束条件向量的第m个元素、第二约束条件向量的第m个元素、第三约束条件向量的第m个元素;σ1为第一罚系数,σ1=1000;σ2为第二罚系数,σ2=1000;σ3为第三罚系数,σ3=1000; 步骤3用控制方法获得多目标优化设计参数 建立第一控制律 其中,v1,i为第i次迭代时臂长设计向量x1的调整量,
的第一下标1和上标1表示该调整量是对设计向量x1中的第一设计变量
的调整量,第二下标i表示迭代次数,
的第一下标1和上标2表示该调整量是对设计向量x1中的第二设计变量
的调整量,第二下标i表示迭代次数; 对第一控制律产生的调整量v1,i的调整幅度进行修正 如果 如果 其中,
表示设计向量x1的第一设计分量
第i—1次迭代后的设计值,
表示设计向量x1的第二设计分量
第i—1次迭代后的设计值; 用修正后的调整值v1,i调整臂长设计向量x1,得到第i次迭代后设计向量x1的值x1,i=x1,i-1+v1,i;e1,i-1为广义工作空间性能指标Z1在第i—1次迭代后的值Z1,i-1与目标值0的误差,e1,i-1=0—Z1,i-1; e2,i-1为广义综合强度性能指标Z2在第i—1次迭代后的值Z2,i-1与目标值0的误差,e2,i-1=0—Z2,i-1; e3,i-1为广义平均控制能量指标Z3在第i—1次迭代后的值Z3,i-1与目标值0的误差,e3,i-1=0—Z3,i-1; e4,i-1为广义平均控制时间指标Z4在第i—1次迭代后的值Z4,i-1与目标值0的误差,e4,i-1=0—Z4,i-1;
为误差值e1,i-1相对于设计向量值x1,i-1的负导数对应的符号向量,
的上标1表示广义工作空间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义工作空间性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e2,i-1相对于设计向量值x1,i-1的负导数对应的符号向量,
的上标2表示广义综合强度性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义综合强度性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x1,i-1的偏导数的符号向量,
的上标3表示广义平均控制能量指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义平均控制能量性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e4,i-1相对于设计向量值x1,i-1的偏导数的符号向量,
的上标4表示广义平均控制时间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义平均控制时间指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e1,i-1在控制律1中的比例系数,
上标1表示广义工作空间性能指标的误差,下标1表示控制律1,并且令
为误差值e2,i-1在控制律1中的比例系数,
上标2表示广义综合强度性能指标的误差,下标1表示控制律1,并且令
为误差值e3,i-1在控制律1中的比例系数,
上标3表示广义平均控制能量性能指标的误差,下标1表示控制律1,并且令
为误差值e4,i-1在控制律1中的比例系数,
上标4表示广义平均控制时间性能指标的误差,下标1表示控制律1,并且令 建立第二控制律 其中,v2,i为第i次迭代时臂厚设计向量x2的调整量,
的第一下标2和上标1表示该调整量是对设计向量x2中的第一设计分量
的调整量,第二下标i表示迭代次数,
的第一下标2和上标2表示该调整量是对设计向量x2中的第二设计分量
的调整量,第二下标i表示迭代次数,
的第一下标2和上标3表示该调整量是对设计向量x2中的第三设计分量
的调整量,第二下标i表示迭代次数,
的第一下标2和上标4表示该调整量是对设计向量x2中的第四设计分量
的调整量,第二下标i表示迭代次数; 对第二控制律产生的调整量v2,i的调整幅度进行修正 如果 如果 其中,
表示设计向量x2的第一设计分量
第i—1次迭代后的设计值,
表示设计向量x2的第二设计分量
第i—1次迭代后的设计值,
表示设计向量x2的第三设计分量
第i—1次迭代后的设计值,
表示设计向量x2的第四设计分量
第i—1次迭代后的设计值; 用修正后的调整值v2,i调整臂厚设计向量,得到第i次迭代后设计向量x2的值x3,i=x2,i-1+v2,i;
为误差值e2,i-1相对于设计向量值x2,i-1的负导数对应的符号向量,
的上标2表示广义综合强度性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
时广义综合强度性能指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x2,i-1的偏导数的符号向量,
的上标3表示广义平均控制能量性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
时广义平均控制能量指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
为误差e2,i-1在控制律2中的比例系数,
上标2表示广义综合强度性能指标的误差,下标2表示控制律2,并且令
为误差e3,i-1在控制律2中的比例系数,
上标3表示广义平均控制能量性能指标的误差,下标2表示控制律1,并且令 建立第三控制律 其中,v3,i为第i次迭代时关节运动学能力设计向量x3的调整量,
的第一下标3和上标1表示该调整量是对设计向量x3中的第一设计分量
的调整量,第二下标i表示迭代次数,
的第一下标3和上标2表示该调整量是对设计向量x3中的第二个设计分量
的调整量,第二下标i表示迭代次数,
的第一下标3和上标3表示该调整量是对设计向量x3中的第三设计分量
的调整量,第二下标i表示迭代次数,
的第一下标3和上标4表示该调整量是对设计向量x3中的第四设计分量
的调整量,第二下标i表示迭代次数;
的第一下标3和上标5表示该调整量是对设计向量x3中的第五设计分量
的调整量,第二下标i表示迭代次数;
的第一下标3和上标6表示该调整量是对设计向量x3中的第六设计分量
的调整量,第二下标i表示迭代次数; 对第三控制律产生的调整量v3,i的调整幅度进行修正 如果 如果 其中,
表示设计向量x3的第一设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第二设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第三设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第四设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第五设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第六设计分量
第i—1次迭代后的设计值; 用修正后的调整量v3,i调整关节的运动学能力设计向量x3,计算第i次迭代后设计向量x3的值x3,i=x3,i-1+v3,i;
为误差值e2,i-1相对于设计向量值x3,i-1的负导数对应的符号向量,
的上标2表示广义综合强度性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
时广义综合强度性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x3,i-1的偏导数的符号向量,
的上标3表示广义平均控制能量性能指标的误差,第一下标3表示运动学能力设计向量,第二下标i—1表示在计算
时广义平均控制能量性能指标的误差值及运动学能力向量的值为第i—1次迭代后的值;
为误差值e4,i-1相对于设计向量值x3,i-1的偏导数的符号向量,
的上标4表示广义平均控制时间性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
时广义平均控制时间性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
为误差值e2,i-1在控制律3中的比例系数,
上标2表示广义综合强度性能指标的误差,下标3表示控制律3,并且令
为误差值e3,i-1在控制律3中的比例系数,
上标3表示广义平均控制能量性能指标的误差,下标3表示控制律3,并且令
为误差值e4,i-1在控制律4中的比例系数,
上标4表示广义平均控制时间性能指标的误差,下标4表示控制律4,并且令 利用第一控制律、第二控制律、第三控制律对臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3进行第一次优化设计 为臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3赋初始设计值,得到向量x1,0、向量x2,0、向量x3,0; 为各性能指标期望值
赋第一次多目标优化设计的参考值
得到对于
其第一下标1表示工作空间性能表,第二下标1表示第一次多目标优化设计,对于
其第一下标2表示综合强度性能指标,第二下标1表示第一次多目标优化设计,对于
其第一下标3表示平均控制能量指标,第二下标1表示第一次多目标优化设计,对于
其第一下标4表示平均控制时间指标,第二下标1表示第一次多目标优化设计; 由第一次多目标优化设计的参考值
及x1,0、x2,0、x3,0计算得到各广义性能指标的初始值Z1,0、Z2,0、Z3,0、Z4,0;如果Z1,0、Z2,0、Z3,0、Z4,0不全部为零,则进入步骤3.1;如果Z1,0、Z2,0、Z3,0、Z4,0全部为零,则设计向量x1、x2、x3的初始值x1,0、x2,0、x3,0即为多目标优化设计参数的值; 步骤3.1对设计变量组成的向量x1、x2、x3进行第一次迭代,迭代次数i=1 首先,由第一控制律及对第一控制律产生的调整量v1,1幅度修正方法 如果 如果 生成对向量x1的第一次迭代的调整值v1,1,再用调整值v1,1调整向量x1,得到向量x1第一次迭代后的值x1,1=x1,0+v1,1;这里,e1,0为广义工作空间性能指标在初始时刻的值Z1,0与目标值0的误差,e1,0=0—Z1,0;e2,0为广义综合强度性能指标在初始时刻的值Z2,0与目标值0的误差,e2,0=0—Z2,0;e3,0为广义平均控制能量指标在初始时刻的值Z3,0与目标值0的误差,e3,0=0—Z3,0;e4,0为广义平均控制时间指标在初始时刻的值Z4,0与目标值0的误差,e4,0=0—Z4,0;
为误差值e1,0相对于设计向量值x1,0的负导数对应的符号向量,
为误差值e2,0相对于设计向量值x1,0的负偏导数对应的符号向量,
为误差值e3,0相对于设计向量值x1,0的负偏导数对应的符号向量,
为误差值e4,0相对于设计向量值x1,0的负偏导数对应的符号向量, 其次,由第二控制律及对第二控制律产生的调整量v2,1的幅度修正方法 如果 如果 生成对臂厚设计向量x2的第一次迭代的调整值v2,1,用调整值v2,1调整臂厚设计向量x2,得到向量x2的第一次迭代后的值x2,1=x2,0+v2,1;这里,
为误差值e2,0相对于设计向量值x2,0的负偏导数对应的符号向量,
为误差值e3,0相对于设计向量值x2,0的负偏导数对应的符号向量, 再次,由第三控制律及对第三控制律产生的调整量v3,1的幅度修正方法 如果 如果 生成对关节运动学能力设计向量x3的第一次调整值v3,1,用调整值v3,1调整关节运动学能力设计向量x3,得到设计向量x3的第一次迭代后的值x3,1=x3,0+v3,1;这里,
为误差值e2,0相对于x3,0的负偏导数对应的符号向量,
为误差值e3,0相对于设计向量值x3,0的负偏导数对应的符号向量,
为误差值e4,0相对于设计向量值x3,0的负偏导数对应的符号向量, 最后,在得到设计向量x1、x2、x3的第一次迭代后的向量值x1,1、x2,1、x3,1之后,计算第一次调整后各广义性能的值Z1,1、Z2,1、Z3,1、Z4,1,如果Z1,1、Z2,1、Z3,1、Z4,1不全部为零,则进入步骤3.2;如果Z1,1、Z2,1、Z3,1、Z4,1全部为零,则所得到的向量x1、x2、x3的第一次迭代的值x1,1、x2,1、x3,1为多目标优化设计参数; 步骤3.2对设计变量组成的向量x1、x2、x3进行第二次迭代,迭代次数i=2 首先,由第一控制律及对第一控制律产生的调整量v1,2幅度修正方法 如果 如果 生成对向量x1的第二次迭代的调整值v1,2,再用调整值v1,2调整向量x2,得到第二次迭代后设计向量x1的值x1,2=x1,1+v1,2;这里,e1,1为广义工作空间性能指标在第一次迭代后的值Z1,1与目标值0的误差,e1,1=0—Z1,1;e2,1为广义综合强度性能指标在第一次迭代后的值Z2,1与目标值0的误差,e2,1=0—Z2,1;e3,1为广义平均控制能量性能指标在第一次迭代后的值Z3,1与目标值0的误差,e3,1=0—Z3,1;e4,1为广义平均控制能量性能指标在第一次迭代后的值Z4,1与目标值0的误差,e4,1=0—Z4,1;
为误差值e1,1相对于设计向量值x1,1的负导数对应的符号向量,
为误差值e2,1相对于设计向量值x1,1的负偏导数对应的符号向量,
为误差值e3,1相对于设计向量值x1,1的负偏导数对应的符号向量,
为误差值e4,1相对于设计向量值x1,1的负偏导数对应的符号向量, 其次,由第二控制律及对第二控制律产生的调整量v2,2的幅度修正方法 如果 如果 生成设计向量x2进行第二次迭代的调整值再用调整值v2,2调整设计向量x2的值,得到第二次迭代后设计向量x2的值x2,2=x2,1+v2,2;这里,
为误差值e2,1相对于设计向量值x3,1的负偏导数对应的符号向量,
为误差值e3,1相对于设计向量值x2,1的负偏导数对应的符号向量, 再次,由第三控制律及对第三控制律产生的调整量v3,2的幅度修正方法 如果 如果 生成设计向量x3的第二次迭代的调整值,再用调整值v3,2调整设计向量x3的值,得到第二次迭代后向量x3的值x3,2=x3,1+v3,2;这里,
为e2,1相对于设计向量值x3,1的负偏导数对应的符号向量,
为误差值e3,1相对于设计向量值x3,1的负偏导数对应的符号向量,
为误差值e4,1相对于设计向量值x3,1的负偏导数对应的符号向量, 最后,用得到的设计向量x1、x2、x3第二次迭代后的值x1,2、x2,2、x3,2,计算第二次迭代后各广义性能的值Z1,2、Z2,2、Z3,2、Z4,2,如果Z1,2、Z2,2、Z3,2、Z4,2不全部为零,则进入步骤3.3;如果Z1,2、Z2,2、Z3,2、Z4,2全部为零,则所得到的向量x1、x2、x3的第二次迭代的值x1,2、x2,2、x3,2即为多目标优化设计参数的值; 步骤3.3依此类推,通过第一控制律及对第一控制律产生的调整量幅度的修正方法,生成设计向量x1进行第j次迭代的调整值v1,j;通过第二控制律及对第二控制律产生的调整量幅度的修正方法,生成设计向量x2进行第j次迭代的调整值v2,j;通过第三控制律及对第三控制律产生的调整量幅度的修正方法,生成设计向量x3进行第j次迭代的调整值v3,j;重复上述迭代,如果在100次迭代内通过调整臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的值可以使广义工作空间性能指标Z1、广义综合强度性能指标Z2、广义平均控制能量指标Z3、广义平均控制时间指标Z4的值同时为零,则获得最终获得使各性能同时得到优化的臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的设计值;如果在100次迭代内无法使得广义工作空间性能指标Z1、广义综合强度性能指标Z2、广义平均控制能量指标Z3、广义平均控制时间指标Z4的值同时为零,则进入步骤3.4,直到各广义性能在100次迭代内使得广义性能指标Z1、Z2、Z3、Z4的值同时为零,获得最终获得使各性能同时得到优化的臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的最终设计值; 步骤3.4对各性能指标期望值
的期望值进行第n—1次调整后进行第n次优化设计,令n为优化设计的次数,对设计向量x1、x2、x3进行第n次优化设计,重复步骤3.1~步骤3.3。
实施例2 对三自由度搬运机器人的基本设计要求为该三自由度工业机器人的工作空间为以(0,0,1)为球心,最大半径Rmax=1.5,最小半径Rmin=0.2的两球之间的部分(单位m)。要求搬运的最大负载质量为25kg。在此基础上,要求工作空间最大化,强度满足材料要求,机械臂控制过程能量、时间性能最优。
对于本设计中的三自由度搬运机器人而言,通过第三章的分析,确定了表征机械设计参数及反应电机性能参数的12个参数作为整个设计过程的设计变量。同时,对于机械臂1的机械参数l1、R1、r1,以及机械臂2、3的内腔参数h2e、b2e、h3e、b3e由于其对性能影响不大,或者由于可以作为预先设计的参数在设计前确定所以这些参数没有作为整个设计的设计参数,作为预先设计值给定。
对于本设计任务,提给定预先设计参数的值分别为l1=1、R1=0.075、r1=0.05、h2e=0.08、b2e=0.08、h3e=0.08、b3e=0.08(单位m)。
下面开始具体的设计。
首先,初始化各设计变量。
x1=
T,x2=
T,x3=[5,5,5,3,3,3]T。
计算初始化设计变量下机械臂各性能为 J1=—1.2,J2=1.3879,J3=1.6411,J4=0.4393。
结合机械臂初始性能,给定各性能最终优化的次最优指标 经过24次叠代,各性能都达到各性能可接受的性能值。在迭代过程中,广义性能指标Z1、Z2、Z3、Z4的值随迭代次数变化的变化图分别由图4、图5、图6、图7所示。
x1=
T,x2=
T,x3=[8.26,7.87,8.48,4.99,4.84,4.28]T 最终性能值为 J1=—1.346,J2=0.642,J3=1.4736,J4=0.3494。
实施例2,各设计变量的变化以及性能指标的变化可通过表1及表2所示。
表1 实施例2中设计变量初始值及最终设计值 表2 实施例2中可接受性能值及性能变化
权利要求
1.一种三自由度搬运工业机器人多目标优化设计参数的获取方法,所述的三自由度搬运工业机器人包括第一机械臂(1)、第二机械臂(2)及第三机械臂(3),第二机械臂(2)的两端分别与第一机械臂(1)的一端、第三机械臂(3)的一端转动连接,其特征在于多目标优化设计参数的获取方法含有以下步骤
步骤1 建立机械臂运动学模型、强度分析模型、基于机电耦合系统动力学模型及逆动力学控制的系统闭环模型,并使用机械臂运动学模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的工作空间性能指标
J1=λ1Rmin-λ2Rmax=f1(l2,l3),
其中,Rmin为工作空间最小半径,Rmax为工作空间最大半径,λ1、λ2分别为最小半径与最大半径的权系数,l2为第二机械臂的臂长,l3为第三机械臂的臂长;
使用强度分析模型获得涉及第二机械臂(2)及第三机械臂(3)的综合强度性能指标
其中,[σ]为第二机械臂(2)及第三机械臂(3)所用材料的许用弯曲应力;σ2max、σ3max分别表示在机器人运动过程中,第二机械臂(2)及第三机械臂(3)上的最大应力;|σ2max-0.8[σ]|、|σ3max-0.8[σ]|分别表示机器人运动过程中,第二机械臂(2)及第三机械臂(3)上的最大应力与材料许用弯曲应力的0.8倍的接近程度,l1为第一机械臂的臂长,b2、h2为第二机械臂(2)外截面的宽度及高度,b2e、h2e为第二机械臂(2)内腔的宽度及高度,b3、h3为第三机械臂(3)外截面的宽度及高度,b3e、h3e为第三机械臂(3)内腔的宽度及高度,
、
分别为第二关节、第三关节的最大角加速度,
、
、
分别为第一关节、第二关节、第三关节的最大角速度,7×107为比例系数;
使用系统闭环模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的平均控制能量指标
及平均控制时间指标
其中,200是指在给定设计要求的工作空间中随机选取400个点作为搬运任务的起止点,由此组成200组搬运任务工作点;n表示第n组搬运任务,mLn表示第n组搬运任务的负载质量,|θ1n|、|θ2n|、|θ3n|分别表示表示完成第n组搬运任务第一关节、第二关节及第三关节的转动角度,τ1(t)、τ2(t)、τ3(t)分别表示完成第n组搬运任务第一关节、第二关节及第三关节在t时刻输出的电磁转矩,tfn表示完成第n组搬运任务的完成时间,R1、r1分别为圆筒形的第一机械臂(1)外半径及内半径,
为第一关节的最大角加速度;
步骤2 对工作空间性能指标、综合强度性能指标、平均控制能量指标及平均控制时间指标涉及的参数进行选择性优化,并建立多目标并行优化模型首先,选择参数l2、l3、b2、h2、b3、h3、
、
、
、
、
、
作为设计变量,对
工作空间性能指标
J1=λ1Rmin-λ2Rmax,
综合强度性能指标
J2=|σ2Zmax-0.8[σ]|+|σ3zmax-0.8[σ]|,
平均控制能量指标
及平均控制时间指标
进行同时优化,得到多目标优化设计任务
其中,x1是由设计变量l2、l3组成的向量,称之为臂长设计向量,其中,
的下标1表示设计向量x1,上标1表示设计向量x1的第一分量,
的下标1表示设计向量x1,上标2表示设计向量x1的第二分量;x2是由设计变量b2、h2、b3、h3组成的向量,称之为臂的厚度设计向量,其中,
的下标2表示设计向量x2,上标1表示设计向量x2的第一分量,
的下标2表示设计向量x2,上标2表示设计向量x2的第二分量,
的下标2表示设计向量x2,上标3表示设计向量x2的第三分量,
的下标2表示设计向量x2,上标4表示设计向量x2的第四分量;x3是由设计变量
、
、
、
、
、
组成的向量,称之为关节的运动学能力设计向量,
的下标3表示设计向量x3,上标1表示设计向量x3的第一分量,
的下标3表示设计向量x3,上标2表示设计向量x3的第二分量,
的下标3表示设计向量x3,上标3表示设计向量x3的第三分量,
的下标3表示设计向量x3,上标4表示设计向量x3的第四分量,
的下标3表示设计向量x3,上标5表示设计向量x3的第五分量,
的下标3表示设计向量x3,上标6表示设计向量x3的第六分量;φ1为第一约束条件向量,φ1=[(l2—l3)—dmin,dmax—(l2+l3),l3—l2,—l2,—l3]T,这里,dmin=0.2,dmax=1.5,分别代表对所设计的机械臂工作空间最小半径与最大半径的设计要求,其值根据具体的设计需要进行调整;φ2为第二约束条件向量,φ2=[h2e-h2,b2e-b2,h3e-h3,b3e-b3]T;φ3为第三约束条件向量
其次,将约束条件与工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4进行合并转化,得到广义工作空间性能指标Z1,广义综合强度性能指标Z2,广义平均控制能量指标Z3及广义平均控制时间指标Z4
其中,
分别是工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4的期望值,
分别表示第一约束条件向量的第m个元素、第二约束条件向量的第m个元素、第三约束条件向量的第m个元素;σ1为第一罚系数,σ1=1000;σ2为第二罚系数,σ2=1000;σ3为第三罚系数,σ3=1000;
步骤3 用控制方法获得多目标优化设计参数
建立第一控制律
其中,v1,i为第i次迭代时臂长设计向量x1的调整量,
的第一下标1和上标1表示该调整量是对设计向量x1中的第一设计变量
的调整量,第二下标i表示迭代次数,
的第一下标1和上标2表示该调整量是对设计向量x1中的第二设计变量
的调整量,第二下标i表示迭代次数;
对第一控制律产生的调整量v1,i的调整幅度进行修正
如果
如果
其中,
表示设计向量x1的第一设计分量
第i—1次迭代后的设计值,
表示设计向量x1的第二设计分量
第i—1次迭代后的设计值;
用修正后的调整值v1,i调整臂长设计向量x1,得到第i次迭代后设计向量x1的值x1,i=x1,i-1+v1,i;e1,i-1为广义工作空间性能指标Z1在第i—1次迭代后的值Z1,i-1与目标值0的误差,e1,i-1=0—Z1,i-1;
e2,i-1为广义综合强度性能指标Z2在第i—1次迭代后的值Z2,i-1与目标值0的误差,e2,i-1=0—Z2,i-1;
e3,i-1为广义平均控制能量指标Z3在第i—1次迭代后的值Z3,i-1与目标值0的误差,e3,i-1=0—Z3,i-1;
e4,i-1为广义平均控制时间指标Z4在第i—1次迭代后的值Z4,i-1与目标值0的误差,e4,i-1=0—Z4,i-1;
为误差值e1,i-1相对于设计向量值x1,i-1的负导数对应的符号向量,
的上标1表示广义工作空间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义工作空间性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e2,i-1相对于设计向量值x1,i-1的负导数对应的符号向量,
的上标2表示广义综合强度性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义综合强度性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x1,i-1的偏导数的符号向量,
的上标3表示广义平均控制能量指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义平均控制能量性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e4,i-1相对于设计向量值x1,i-1的偏导数的符号向量,
的上标4表示广义平均控制时间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
时广义平均控制时间指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e1,i-1在控制律1中的比例系数,
上标1表示广义工作空间性能指标的误差,下标1表示控制律1,并且令
为误差值e2,i-1在控制律1中的比例系数,
上标2表示广义综合强度性能指标的误差,下标1表示控制律1,并且令
为误差值e3,i-1在控制律1中的比例系数,
上标3表示广义平均控制能量性能指标的误差,下标1表示控制律1,并且令
为误差值e4,i-1在控制律1中的比例系数,
上标4表示广义平均控制时间性能指标的误差,下标1表示控制律1,并且令
建立第二控制律
其中,v2,i为第i次迭代时臂厚设计向量x2的调整量,
的第一下标2和上标1表示该调整量是对设计向量x2中的第一设计分量
的调整量,第二下标i表示迭代次数,
的第一下标2和上标2表示该调整量是对设计向量x2中的第二设计分量
的调整量,第二下标i表示迭代次数,
的第一下标2和上标3表示该调整量是对设计向量x2中的第三设计分量
的调整量,第二下标i表示迭代次数,
的第一下标2和上标4表示该调整量是对设计向量x2中的第四设计分量
的调整量,第二下标i表示迭代次数;
对第二控制律产生的调整量v2,i的调整幅度进行修正
如果
如果
其中,
表示设计向量x2的第一设计分量
第i—1次迭代后的设计值,
表示设计向量x2的第二设计分量
第i—1次迭代后的设计值,
表示设计向量x2的第三设计分量
第i—1次迭代后的设计值,
表示设计向量x2的第四设计分量
第i—1次迭代后的设计值;
用修正后的调整值v2,i调整臂厚设计向量,得到第i次迭代后设计向量x2的值x2,i=x2,i-1+v2,i;
为误差值e2,i-1相对于设计向量值x2,i-1的负导数对应的符号向量,
的上标2表示广义综合强度性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
时广义综合强度性能指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x2,i-1的偏导数的符号向量,
的上标3表示广义平均控制能量性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
时广义平均控制能量指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
为误差e2,i-1在控制律2中的比例系数,
上标2表示广义综合强度性能指标的误差,下标2表示控制律2,并且令
为误差e3,i-1在控制律2中的比例系数,
上标3表示广义平均控制能量性能指标的误差,下标2表示控制律1,并且令
建立第三控制律
其中,v3,i为第i次迭代时关节运动学能力设计向量x3的调整量,
的第一下标3和上标1表示该调整量是对设计向量x3中的第一设计分量
的调整量,第二下标i表示迭代次数,
的第一下标3和上标2表示该调整量是对设计向量x3中的第二个设计分量
的调整量,第二下标i表示迭代次数,
的第一下标3和上标3表示该调整量是对设计向量x3中的第三设计分量
的调整量,第二下标i表示迭代次数,
的第一下标3和上标4表示该调整量是对设计向量x3中的第四设计分量
的调整量,第二下标i表示迭代次数;
的第一下标3和上标5表示该调整量是对设计向量x3中的第五设计分量
的调整量,第二下标i表示迭代次数;
的第一下标3和上标6表示该调整量是对设计向量x3中的第六设计分量
的调整量,第二下标i表示迭代次数;
对第三控制律产生的调整量v3,i的调整幅度进行修正
如果
如果
其中,
表示设计向量x3的第一设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第二设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第三设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第四设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第五设计分量
第i—1次迭代后的设计值,
表示设计向量x3的第六设计分量
第i—1次迭代后的设计值;
用修正后的调整量v3,i调整关节的运动学能力设计向量x3,计算第i次迭代后设计向量x3的值x3,i=x3,i-1+v3,i;
为误差值e2,i-1相对于设计向量值x3,i-1的负导数对应的符号向量,
的上标2表示广义综合强度性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
时广义综合强度性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x3,i-1的偏导数的符号向量,
的上标3表示广义平均控制能量性能指标的误差,第一下标3表示运动学能力设计向量,第二下标i—1表示在计算
时广义平均控制能量性能指标的误差值及运动学能力向量的值为第i—1次迭代后的值;
为误差值e4,i-1相对于设计向量值x3,i-1的偏导数的符号向量,
的上标4表示广义平均控制时间性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
时广义平均控制时间性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
为误差值e2,i-1在控制律3中的比例系数,
上标2表示广义综合强度性能指标的误差,下标3表示控制律3,并且令
为误差值e3,i-1在控制律3中的比例系数,
上标3表示广义平均控制能量性能指标的误差,下标3表示控制律3,并且令
为误差值e4,i-1在控制律4中的比例系数,
上标4表示广义平均控制时间性能指标的误差,下标4表示控制律4,并且令
利用第一控制律、第二控制律、第三控制律对臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3进行第一次优化设计
为臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3赋初始设计值,得到向量x1,0、向量x2,0、向量x3,0;
为各性能指标期望值
赋第一次多目标优化设计的参考值
得到对于
其第一下标1表示工作空间性能表,第二下标1表示第一次多目标优化设计,对于
其第一下标2表示综合强度性能指标,第二下标1表示第一次多目标优化设计,对于
,其第一下标3表示平均控制能量指标,第二下标1表示第一次多目标优化设计,对于
,其第一下标4表示平均控制时间指标,第二下标1表示第一次多目标优化设计;
由第一次多目标优化设计的参考值
及x1,0、x2,0、x3,0计算得到各广义性能指标的初始值Z1,0、Z2,0、Z3,0、Z4,0;如果Z1,0、Z2,0、Z3,0、Z4,0不全部为零,则进入步骤3,1;如果Z1,0、Z2,0、Z3,0、Z4,0全部为零,则设计向量x1、x2、x3的初始值x1,0、x2,0、x3,0即为多目标优化设计参数的值;
步骤3.1 对设计变量组成的向量x1、x2、x3进行第一次迭代,迭代次数i=1
首先,由第一控制律及对第一控制律产生的调整量v1,1幅度修正方法
如果
如果
生成对向量x1的第一次迭代的调整值v1,1,再用调整值v1,1调整向量x1,得到向量x1第一次迭代后的值x1,1=x1,0+v1,1;这里,e1,0为广义工作空间性能指标在初始时刻的值Z1,0与目标值0的误差,e1,0=0—Z1,0;e2,0为广义综合强度性能指标在初始时刻的值Z2,0与目标值0的误差,e2,0=0—Z2,0;e3,0为广义平均控制能量指标在初始时刻的值Z3,0与目标值0的误差,e3,0=0—Z3,0;e4,0为广义平均控制时间指标在初始时刻的值Z4,0与目标值0的误差,e4,0=0—Z4,0;
为误差值e1,0相对于设计向量值x1,0的负导数对应的符号向量,
为误差值e2,0相对于设计向量值x1,0的负偏导数对应的符号向量,
为误差值e3,0相对于设计向量值x1,0的负偏导数对应的符号向量,
为误差值e4,0相对于设计向量值x1,0的负偏导数对应的符号向量,
其次,由第二控制律及对第二控制律产生的调整量v2,1的幅度修正方法
如果
如果
生成对臂厚设计向量x2的第一次迭代的调整值v2,1’用调整值v2,1调整臂厚设计向量x2,得到向量x2的第一次迭代后的值x2,1=x2,0+v2,1;这里,
为误差值e2,0相对于设计向量值x2,0的负偏导数对应的符号向量,
为误差值e3,0相对于设计向量值x2,0的负偏导数对应的符号向量,
再次,由第三控制律及对第三控制律产生的调整量v3,1的幅度修正方法
如果
如果
生成对关节运动学能力设计向量x3的第一次调整值v3,1’用调整值v3,1调整关节运动学能力设计向量x3,得到设计向量x3的第一次迭代后的值x3,1=x3,0+v3,1;这里,
为误差值e2,0相对于x3,0的负偏导数对应的符号向量,
为误差值e3,0相对于设计向量值x3,0的负偏导数对应的符号向量,
为误差值e4,0相对于设计向量值x3,0的负偏导数对应的符号向量,
最后,在得到设计向量x1、x2、x3的第一次迭代后的向量值x1,1、x2,1、x3,1之后,计算第一次调整后各广义性能的值Z1,1、Z2,1、Z3,1、Z4,1,如果Z1,1、Z2,1、Z3,1、Z4,1不全部为零,则进入步骤3.2;如果Z1,1、Z2,1、Z3,1、Z4,1全部为零,则所得到的向量x1、x2、x3的第一次迭代的值x1,1、x2,1、x3,1为多目标优化设计参数;
步骤3.2 对设计变量组成的向量x1、x2、x3进行第二次迭代,迭代次数i=2首先,由第一控制律及对第一控制律产生的调整量v1,2幅度修正方法
如果
如果
生成对向量x1的第二次迭代的调整值v1,2,再用调整值v1,2调整向量x2,得到第二次迭代后设计向量x1的值x1,2=x1,1+v1,2;这里,e1,1为广义工作空间性能指标在第一次迭代后的值Z1,1与目标值0的误差,e1,1=0—Z1,1;e2,1为广义综合强度性能指标在第一次迭代后的值Z2,1与目标值0的误差,e2,1=0—Z2,1;e3,1为广义平均控制能量性能指标在第一次迭代后的值Z3,1与目标值0的误差,e3,1=0—Z3,1;e4,1为广义平均控制能量性能指标在第一次迭代后的值Z4,1与目标值0的误差,e4,1=0—Z4,1;
为误差值e1,1相对于设计向量值x1,1的负导数对应的符号向量,
为误差值e2,1相对于设计向量值x1,1的负偏导数对应的符号向量,
为误差值e3,1相对于设计向量值x1,1的负偏导数对应的符号向量,
为误差值e4,1相对于设计向量值x1,1的负偏导数对应的符号向量,
其次,由第二控制律及对第二控制律产生的调整量v2,2的幅度修正方法
如果
如果
生成设计向量x2进行第二次迭代的调整值再用调整值v2,2调整设计向量x2的值,得到第二次迭代后设计向量x2的值x2,2=x2,1+v2,2;这里,
为误差值e2,1相对于设计向量值x2,1的负偏导数对应的符号向量,
为误差值e3,1相对于设计向量值x2,1的负偏导数对应的符号向量,
再次,由第三控制律及对第三控制律产生的调整量v3,2的幅度修正方法
如果
如果
生成设计向量x3的第二次迭代的调整值,再用调整值v3,2调整设计向量x3的值,得到第二次迭代后向量x3的值x3,2=x3,1+v3,2;这里,
为e2,1相对于设计向量值x3,1的负偏导数对应的符号向量,
为误差值e3,1相对于设计向量值x3,1的负偏导数对应的符号向量,
为误差值e4,1相对于设计向量值x3,1的负偏导数对应的符号向量,
最后,用得到的设计向量x1、x2、x3第二次迭代后的值x1,2、x2,2、x3,2,计算第二次迭代后各广义性能的值Z1,2、Z2,2、Z3,2、Z4,2,如果Z1,2、Z2,2、Z3,2、Z4,2不全部为零,则进入步骤3.3;如果Z1,2、Z2,2、Z3,2、Z4,2全部为零,则所得到的向量x1、x2、x3的第二次迭代的值x1,2、x2,2、x3,2即为多目标优化设计参数的值;
步骤3.3 依此类推,通过第一控制律及对第一控制律产生的调整量幅度的修正方法,生成设计向量x1进行第j次迭代的调整值v1,j;通过第二控制律及对第二控制律产生的调整量幅度的修正方法,生成设计向量x2进行第j次迭代的调整值v2,j;通过第三控制律及对第三控制律产生的调整量幅度的修正方法,生成设计向量x3进行第j次迭代的调整值v3,j;重复上述迭代,如果在100次迭代内通过调整臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的值可以使广义工作空间性能指标Z1、广义综合强度性能指标Z2、广义平均控制能量指标Z3、广义平均控制时间指标Z4的值同时为零,则获得最终获得使各性能同时得到优化的臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的设计值;如果在100次迭代内无法使得广义工作空间性能指标Z1、广义综合强度性能指标Z2、广义平均控制能量指标Z3、广义平均控制时间指标Z4的值同时为零,则进入步骤3.4,直到各广义性能在100次迭代内使得广义性能指标Z1、Z2、Z3、Z4的值同时为零,获得最终获得使各性能同时得到优化的臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3的最终设计值;
步骤3.4 对各性能指标期望值
的期望值进行第n—1次调整后进行第n次优化设计,令n为优化设计的次数,对设计向量x1、x2、x3进行第n次优化设计,重复步骤3.1~步骤3.3。
全文摘要
一种工业机器人多目标优化设计的方法。该方法由三个步骤组成首先,通过建立机械臂运动学模型、强度分析模型、基于机电耦合系统动力学模型及逆动力学控制的系统闭环模型,获得表征机械臂工作空间、强度、控制能量、控制时间的四个性能指标及其计算方法;其次,对四个性能指标涉及到的机器人设计参数进行选择性优化,建立了多目标优化设计模型;最后,通过控制的方法,对机械臂的设计参数进行调整,对四个目标进行并行优化,最终获得同时满足四个性能要求的设计参数的设计值,从而为整体提高工业机器人性能提供了一种方法。
文档编号G06F17/50GK101508112SQ20091003006
公开日2009年8月19日 申请日期2009年3月30日 优先权日2009年3月30日
发明者峥 汪, 琦 陈, 佳 胡 申请人:东南大学