CN101508112A - 三自由度搬运工业机器人多目标优化设计参数的获取方法 - Google Patents

三自由度搬运工业机器人多目标优化设计参数的获取方法 Download PDF

Info

Publication number
CN101508112A
CN101508112A CNA2009100300626A CN200910030062A CN101508112A CN 101508112 A CN101508112 A CN 101508112A CN A2009100300626 A CNA2009100300626 A CN A2009100300626A CN 200910030062 A CN200910030062 A CN 200910030062A CN 101508112 A CN101508112 A CN 101508112A
Authority
CN
China
Prior art keywords
mrow
msubsup
math
msub
vector
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CNA2009100300626A
Other languages
English (en)
Other versions
CN101508112B (zh
Inventor
汪峥
陈琦
胡佳
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Southeast University filed Critical Southeast University
Priority to CN2009100300626A priority Critical patent/CN101508112B/zh
Publication of CN101508112A publication Critical patent/CN101508112A/zh
Application granted granted Critical
Publication of CN101508112B publication Critical patent/CN101508112B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Feedback Control In General (AREA)

Abstract

一种工业机器人多目标优化设计的方法。该方法由三个步骤组成:首先,通过建立机械臂运动学模型、强度分析模型、基于机电耦合系统动力学模型及逆动力学控制的系统闭环模型,获得表征机械臂工作空间、强度、控制能量、控制时间的四个性能指标及其计算方法;其次,对四个性能指标涉及到的机器人设计参数进行选择性优化,建立了多目标优化设计模型;最后,通过控制的方法,对机械臂的设计参数进行调整,对四个目标进行并行优化,最终获得同时满足四个性能要求的设计参数的设计值,从而为整体提高工业机器人性能提供了一种方法。

Description

三自由度搬运工业机器人多目标优化设计参数的获取方法
技术领域
本发明涉及一种搬运工业机器人设计参数的获取方法,尤其涉及一种三自由度搬运工业机器人多目标优化设计参数的获取方法。
背景技术
工业机器人是一种典型的复杂系统,对于一个复杂系统的设计优化而言,其主要特点为:由于复杂工程系统通常包含若干个具有特定功能的子系统,系统和子系统都有各自相应的设计目标、设计参数和约束条件,同时又由于子系统之间存在复杂的耦合关系,因此复杂工程系统的设计过程已经成为一个多学科交叉综合设计的多目标优化决策过程。由最优组件和子系统组成的大系统,并不一定是整体性能最优的系统。因此,复杂工程系统的设计过程需要能够兼顾不同因素之间复杂耦合关系的优化理论与方法的支持。
在工业机器人的设计中,机械系统设计影响传动系统、控制系统的设计,传动系统设计影响控制系统的设计,同时,控制系统设计又影响机械系统和传动系统设计。但是,在传统工业机器人设计流程中,机械系统、传动系统、控制系统的设计依次单独进行,因而上游子系统设计无法兼顾下游子系统设计的设计指标,下游子系统设计也无法兼顾上游子系统设计的设计指标,从而影响了系统整体性能的提高。
发明内容
本发明提供一种能够实现并行优化的三自由度搬运工业机器人多目标优化设计参数的获取方法。
本发明采用如下技术方案:
步骤1建立机械臂运动学模型、强度分析模型、基于机电耦合系统动力学模型及逆动力学控制的系统闭环模型,并使用机械臂运动学模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的工作空间性能指标:
J1=λ1Rmin2Rmax=f1(l2,l3),
其中,Rmin为工作空间最小半径,Rmax为工作空间最大半径,λ1、λ2分别为最小半径与最大半径的权系数,l2为第二机械臂的臂长,l3为第三机械臂的臂长;
使用强度分析模型获得涉及第二机械臂(2)及第三机械臂(3)的综合强度性能指标:
J 2 = ( | σ 2 max - 0.8 [ σ ] | + | σ 3 max - 0.8 [ σ ] | ) / ( 7 × 10 7 )
= f 2 ( l 2 , b 2 , h 2 , b 2 e , h 2 e , l 3 , b 3 , h 3 , b 3 e , h 3 e , θ . . 2 max , θ . . 3 max , θ . 1 max , θ . 2 max , θ . 3 max ) ,
其中,[σ]为第二机械臂(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)内腔的宽度及高度,
Figure A200910030062D00183
分别为第二关节、第三关节的最大角加速度,分别为第一关节、第二关节、第三关节的最大角速度,7×107为比例系数;
使用系统闭环模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的平均控制能量指标:
J 3 = 1 200 Σ n = 1 200 1 m Ln ( | θ 1 n | + | θ 2 n | + | θ 3 n | ) [ ∫ 0 t fn | τ 1 ( t ) | dt + ∫ 0 t fn | τ 2 ( t ) | dt + ∫ 0 t fn | τ 3 ( t ) | dt ] ,
   = f 3 ( l 1 , R 1 , r 1 , l 2 , b 2 , h 2 , b 2 e , h 2 e , l 3 , b 3 , h 3 , b 3 e , h 3 e , θ . . 1 max , θ . . 2 max , θ . . 3 max , θ . 1 max , θ . 2 max , θ . 3 max )
及平均控制时间指标
J 4 = 1 200 Σ n = 1 200 t fn ( | θ 1 n | + | θ 2 n | + | θ 3 n | ) = f 4 ( l 1 , l 2 , l 3 , θ . . 1 max , θ . . 2 max , θ . . 3 max , θ . 1 max , θ . 2 max , θ . 3 max ) ,
其中,200是指在给定设计要求的工作空间中随机选取400个点作为搬运任务的起止点,由此组成200组搬运任务工作点;n表示第n组搬运任务,mLn表示第n组搬运任务的负载质量,|θ1n|、|θ2n|、|θ3n|分别表示表示完成第n组搬运任务第一关节、第二关节及第三关节的转动角度,τ1(t)、τ2(t)、τ3(t)分别表示完成第n组搬运任务第一关节、第二关节及第三关节在t时刻输出的电磁转矩,tfn表示完成第n组搬运任务的完成时间,R1、r1分别为圆筒形的第一机械臂(1)外半径及内半径,
Figure A200910030062D00191
为第一关节的最大角加速度;
步骤2对工作空间性能指标、综合强度性能指标、平均控制能量指标及平均控制时间指标涉及的参数进行选择性优化,并建立多目标并行优化模型
首先,选择参数l2、l3、b2、h2、b3、h3 θ . . 1 max , θ . . 2 max , θ . . 3 max , θ . 1 max , θ . 2 max ,
Figure A200910030062D00193
作为设计变量,对
工作空间性能指标
J1=λ1Rmin2Rmax
综合强度性能指标
J2=|σ2Zmax-0.8[σ]|+|σ3Zmax-0.8[σ]|,
平均控制能量指标
J 3 = 1 200 Σ n = 1 200 1 m Ln ( | θ 1 n | + | θ 2 n | + | θ 3 n | ) [ ∫ 0 t fn | τ 1 ( t ) | dt + ∫ 0 t fn | τ 2 ( t ) | dt + ∫ 0 t fn | τ 3 ( t ) | dt ] ,
及平均控制时间指标
J 4 = 1 200 Σ n = 1 200 t fn ( | θ 1 n | + | θ 2 n | + | θ 3 n | )
进行同时优化,得到多目标优化设计任务:
min J 1 ( x 1 ) min J 2 ( x 2 ; x 1 , x 3 ) min J 3 ( x 3 ; x 1 , x 2 ) min J 4 ( x 3 ; x 1 ) s . t φ 1 ≤ 0 ; φ 2 ≤ 0 ; φ 3 ≤ 0
其中,x1是由设计变量l2、l3组成的向量, x 1 = [ x 1 1 , x 1 2 ] T = [ l 2 , l 3 ] T , 称之为臂长设计向量,其中,
Figure A200910030062D00198
的下标1表示设计向量x1,上标1表示设计向量x1的第一分量,
Figure A200910030062D00199
的下标1表示设计向量x1,上标2表示设计向量x1的第二分量;x2是由设计变量b2、h2、b3、h3组成的向量, x 2 = [ x 2 1 , x 2 2 , x 2 3 , x 2 4 ] T = [ h 2 , b 2 , h 3 , b 3 ] T , 称之为臂的厚度设计向量,其中,
Figure A200910030062D001911
的下标2表示设计向量x2,上标1表示设计向量x2的第一分量,
Figure A200910030062D001912
的下标2表示设计向量x2,上标2表示设计向量x2的第二分量,的下标2表示设计向量x2,上标3表示设计向量x2的第三分量,
Figure A200910030062D001914
的下标2表示设计向量x2,上标4表示设计向量x2的第四分量;x3是由设计变量 θ . . 1 max , θ . . 2 max , θ . . 3 max , θ . 1 max , θ . 2 max , θ . 3 max 组成的向量, x 3 = [ x 3 1 , x 3 2 , x 3 3 , x 3 4 , x 3 5 , x 3 6 ] T = [ θ . . 1 max , θ . . 2 max , θ . . 3 max , θ . 1 max , θ . 2 max , θ . 3 max ] T 称之为关节的运动学能力设计向量,
Figure A200910030062D00203
的下标3表示设计向量x3,上标1表示设计向量x3的第一分量,的下标3表示设计向量x3,上标2表示设计向量x3的第二分量,
Figure A200910030062D00205
的下标3表示设计向量x3,上标3表示设计向量x3的第三分量,
Figure A200910030062D00206
的下标3表示设计向量x3,上标4表示设计向量x3的第四分量,的下标3表示设计向量x3,上标5表示设计向量x3的第五分量,
Figure A200910030062D00208
的下标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为第三约束条件向量 φ 3 = [ - θ . . 1 max , - θ . . 2 max , - θ . . 3 max , - θ . 1 max , - θ . 2 max , - θ . 3 max ] T ;
其次,将约束条件与工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4进行合并转化,得到广义工作空间性能指标Z1,广义综合强度性能指标Z2,广义平均控制能量指标Z3及广义平均控制时间指标Z4
Z 1 = max { 0 , J 1 - J 1 * } + σ 1 Σ m = 1 5 max { 0 , φ 1 m } 2 Z 2 = max { 0 , J 2 - J 2 * } + σ 2 Σ m = 1 4 max { 0 , φ 2 m } 2 Z 3 = max { 0 , J 3 - J 3 * } + σ 3 Σ m = 1 6 max { 0 , φ 3 m } 2 Z 4 = max { 0 , J 4 - J 4 * }
其中,
Figure A200910030062D002011
分别是工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4的期望值,
Figure A200910030062D002012
分别表示第一约束条件向量的第m个元素、第二约束条件向量的第m个元素、第三约束条件向量的第m个元素;σ1为第一罚系数,σ1=1000;σ2为第二罚系数,σ2=1000;σ3为第三罚系数,σ3=1000;
步骤3用控制方法获得多目标优化设计参数
建立第一控制律: v 1 , i = k 1 1 e 1 , i - 1 o 1 , i - 1 1 + k 1 2 e 2 , i - 1 o 1 , i - 1 2 + k 1 3 e 3 , i - 1 o 1 , i - 1 3 + k 1 4 e 4 , i - 1 o 1 , i - 1 4
其中,v1,i为第i次迭代时臂长设计向量x1的调整量, v 1 , i = [ v 1 , i 1 , v 1 , i 2 ] T ,
Figure A200910030062D00213
的第一下标1和上标1表示该调整量是对设计向量x1中的第一设计变量
Figure A200910030062D00214
的调整量,第二下标i表示迭代次数,
Figure A200910030062D00215
的第一下标1和上标2表示该调整量是对设计向量x1中的第二设计变量
Figure A200910030062D00216
的调整量,第二下标i表示迭代次数;
对第一控制律产生的调整量v1,i的调整幅度进行修正:
如果 0 < | v 1 , i 1 | &le; 0.01 | x 1 , i - 1 1 | , v 1 , i 1 = sign ( x 1 , i - 1 1 ) &times; 0.01 | x 1 , i - 1 1 | ,
0 < | v 1 , i 2 | &le; 0.01 | x 1 , i - 1 2 | , v 1 , i 2 = sign ( x 1 , i - 1 2 ) &times; 0.01 | x 1 , i - 1 2 | ,
如果 | v 1 , i 1 | &GreaterEqual; 0.04 | x 1 , i - 1 1 | , v 1 , i 1 = sign ( x 1 , i - 1 1 ) &times; 0.04 | x 1 , i - 1 1 | ,
| v 1 , i 2 | &GreaterEqual; 0.04 | x 1 , i - 1 2 | , v 1 , i 2 = sign ( x 1 , i - 1 2 ) &times; 0.04 | x 1 , i - 1 2 | ;
其中,
Figure A200910030062D002115
表示设计向量x1的第一设计分量
Figure A200910030062D0021145916QIETU
第i—1次迭代后的设计值,
Figure A200910030062D002116
表示设计向量x1的第二设计分量
Figure A200910030062D002117
第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的负导数对应的符号向量, o 1 , i - 1 2 = sign { - de 1 , i - 1 dx 1 , i - 1 } ,
Figure A200910030062D002120
的上标1表示广义工作空间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062D002121
时广义工作空间性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062D00221
为误差值e2,i-1相对于设计向量值x1,i-1的负导数对应的符号向量, o 1 , i - 1 2 = sign { - &PartialD; e 2 , i - 1 &PartialD; x 1 , i - 1 } , 的上标2表示广义综合强度性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062D00224
时广义综合强度性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062D00225
为误差值e3,i-1相对于设计向量值x1,i-1的偏导数的符号向量, o 1 , i - 1 3 = sign { - &PartialD; e 3 , i - 1 &PartialD; x 1 , i - 1 } ,
Figure A200910030062D00227
的上标3表示广义平均控制能量指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062D00228
时广义平均控制能量性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062D00229
为误差值e4,i-1相对于设计向量值x1,i-1的偏导数的符号向量, o 1 , i - 1 4 = sign { - &PartialD; e 4 , i - 1 &PartialD; x 1 , i - 1 } ,
Figure A200910030062D002211
的上标4表示广义平均控制时间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062D002212
时广义平均控制时间指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062D002213
为误差值e1,i-1在控制律1中的比例系数,
Figure A200910030062D002214
上标1表示广义工作空间性能指标的误差,下标1表示控制律1,并且令 k 1 1 = 1 ;
Figure A200910030062D002216
为误差值e2,i-1在控制律1中的比例系数,
Figure A200910030062D002217
上标2表示广义综合强度性能指标的误差,下标1表示控制律1,并且令 k 1 2 = 1 &times; 10 - 2 ;
Figure A200910030062D002219
为误差值e3,i-1在控制律1中的比例系数,
Figure A200910030062D002220
上标3表示广义平均控制能量性能指标的误差,下标1表示控制律1,并且令 k 1 3 = 5 &times; 10 - 4 ;
Figure A200910030062D002222
为误差值e4,i-1在控制律1中的比例系数,
Figure A200910030062D002223
上标4表示广义平均控制时间性能指标的误差,下标1表示控制律1,并且令 k 1 4 = 1 &times; 10 - 4 ;
建立第二控制律: v 2 , i = k 2 2 e 2 , i - 1 o 2 , i - 1 2 + k 2 3 e 3 , i - 1 o 2 , i - 1 3
其中,v2,i为第i次迭代时臂厚设计向量x2的调整量, v 2 , i = [ v 2 , i 1 , v 2 , i 2 , v 2 , i 3 , v 2 , i 4 ] T ,
Figure A200910030062D002227
的第一下标2和上标1表示该调整量是对设计向量x2中的第一设计分量
Figure A200910030062D002228
的调整量,第二下标i表示迭代次数,
Figure A200910030062D002229
的第一下标2和上标2表示该调整量是对设计向量x2中的第二设计分量
Figure A200910030062D00231
的调整量,第二下标i表示迭代次数,
Figure A200910030062D00232
的第一下标2和上标3表示该调整量是对设计向量x2中的第三设计分量
Figure A200910030062D00233
的调整量,第二下标i表示迭代次数,的第一下标2和上标4表示该调整量是对设计向量x2中的第四设计分量
Figure A200910030062D00235
的调整量,第二下标i表示迭代次数;
对第二控制律产生的调整量v2,i的调整幅度进行修正:
如果 0 < | v 2 , i 1 | &le; 0.01 | x 2 , i - 1 1 | , v 2 , i 1 = sign ( x 2 , i - 1 1 ) &times; 0.01 | x 2 , i - 1 1 | ,
0 < | v 2 , i 2 | &le; 0.01 | x 2 , i - 1 2 | , v 2 , i 2 = sign ( x 2 , i - 1 2 ) &times; 0.01 | x 2 , i - 1 2 | ,
0 < | v 2 , i 3 | &le; 0.01 | x 2 , i - 1 3 | , v 2 , i 3 = sign ( x 2 , i - 1 3 ) &times; 0.01 | x 2 , i - 1 3 | ,
0 < | v 2 , i 4 | &le; 0.01 | x 2 , i - 1 4 | , v 2 , i 4 = sign ( x 2 , i - 1 4 ) &times; 0.01 | x 2 , i - 1 4 | ;
如果 | v 2 , i 1 | &GreaterEqual; 0.02 | x 2 , i - 1 1 | , v 2 , i 1 = sign ( x 2 , i - 1 1 ) &times; 0.02 | x 2 , i - 1 1 | ,
| v 2 , i 2 | &GreaterEqual; 0.02 | x 2 , i - 1 2 | , v 2 , i 2 = sign ( x 2 , i - 1 2 ) &times; 0.02 | x 2 , i - 1 2 | ,
| v 2 , i 3 | &GreaterEqual; 0.02 | x 2 , i - 1 3 | , v 2 , i 3 = sign ( x 2 , i - 1 3 ) &times; 0.02 | x 2 , i - 1 3 | ,
| v 2 , i 4 | &GreaterEqual; 0.02 | x 2 , i - 1 4 | , v 2 , i 4 = sign ( x 2 , i - 1 4 ) &times; 0.02 | x 2 , i - 1 4 | ,
其中,表示设计向量x2的第一设计分量第i—1次迭代后的设计值,
Figure A200910030062D002323
表示设计向量x2的第二设计分量
Figure A200910030062D002324
第i—1次迭代后的设计值,
Figure A200910030062D002325
表示设计向量x2的第三设计分量
Figure A200910030062D002326
第i—1次迭代后的设计值,
Figure A200910030062D002327
表示设计向量x2的第四设计分量
Figure A200910030062D002328
第i—1次迭代后的设计值;
用修正后的调整值v2,i调整臂厚设计向量,得到第i次迭代后设计向量x2的值x2,i=x2,i-1+v2,i
Figure A200910030062D002329
为误差值e2,i-1相对于设计向量值x2,i-1的负导数对应的符号向量, o 2 , i - 1 2 = sign { - &PartialD; e 2 , i - 1 &PartialD; x 2 , i - 1 } ,
Figure A200910030062D002331
的上标2表示广义综合强度性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算时广义综合强度性能指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
Figure A200910030062D002333
为误差值e3,i-1相对于设计向量值x2,i-1的偏导数的符号向量, o 2 i - 1 3 = sign { - &PartialD; e 3 , i - 1 &PartialD; x 2 , i - 1 } , 的上标3表示广义平均控制能量性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
Figure A200910030062D00243
时广义平均控制能量指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
为误差e2,i-1在控制律2中的比例系数,
Figure A200910030062D00245
上标2表示广义综合强度性能指标的误差,下标2表示控制律2,并且令 k 2 2 = 1 ;
Figure A200910030062D00247
为误差e3,i-1在控制律2中的比例系数,
Figure A200910030062D00248
上标3表示广义平均控制能量性能指标的误差,下标2表示控制律1,并且令 k 2 3 = 1 &times; 10 - 2 ;
建立第三控制律: v 3 , i - 1 = k 3 2 e 2 , i - 1 o 3 , i - 1 2 + k 3 3 e 3 , i - 1 o 3 , i - 1 3 + k 3 4 e 4 , i - 1 o 3 , i - 1 4
其中,v3,i为第i次迭代时关节运动学能力设计向量x3的调整量, v 3 , i = [ v 3 , i 1 , v 3 , i 2 , v 3 , i 3 , v 3 , i 4 , v 3 , i 5 , v 3 , i 6 ] T ,
Figure A200910030062D002413
的第一下标3和上标1表示该调整量是对设计向量x3中的第一设计分量
Figure A200910030062D002414
的调整量,第二下标i表示迭代次数,的第一下标3和上标2表示该调整量是对设计向量x3中的第二个设计分量
Figure A200910030062D002416
的调整量,第二下标i表示迭代次数,
Figure A200910030062D002417
的第一下标3和上标3表示该调整量是对设计向量x3中的第三设计分量
Figure A200910030062D002418
的调整量,第二下标i表示迭代次数,
Figure A200910030062D002419
的第一下标3和上标4表示该调整量是对设计向量x3中的第四设计分量
Figure A200910030062D002420
的调整量,第二下标i表示迭代次数;
Figure A200910030062D002421
的第一下标3和上标5表示该调整量是对设计向量x3中的第五设计分量
Figure A200910030062D002422
的调整量,第二下标i表示迭代次数;
Figure A200910030062D002423
的第一下标3和上标6表示该调整量是对设计向量x3中的第六设计分量
Figure A200910030062D002424
的调整量,第二下标i表示迭代次数;
对第三控制律产生的调整量v3,i的调整幅度进行修正:
如果 0 < | v 3 , i 1 | &le; 0.01 | x 3 , i - 1 1 | , v 3 , i 1 = sign ( x 3 , i - 1 1 ) &times; 0.01 | x 3 , i - 1 1 | ,
0 < | v 3 , i 2 | &le; 0.01 | x 3 , i - 1 2 | , v 3 , i 2 = sign ( x 3 , i - 1 2 ) &times; 0.01 | x 3 , i - 1 2 | ,
0 < | v 3 , i 3 | &le; 0.01 | x 3 , i - 1 3 | , v 3 , i 3 = sign ( x 3 , i - 1 3 ) &times; 0.01 | x 3 , i - 1 3 | ,
0 < | v 3 , i 4 | &le; 0.01 | x 3 , i - 1 4 | , v 3 , i 4 = sign ( x 3 , i - 1 4 ) &times; 0.01 | x 3 , i - 1 4 | ,
0 < | v 3 , i 5 | &le; 0.01 | x 3 , i - 1 5 | , v 3 , i 5 = sign ( x 3 , i - 1 5 ) &times; 0.01 | x 3 , i - 1 5 | ,
0 < | v 3 , i 6 | &le; 0.01 | x 3 , i - 1 6 | , v 3 , i 6 = sign ( x 3 , i - 1 6 ) &times; 0.01 | x 3 , i - 1 6 | ;
如果 | v 3 , i 1 | &GreaterEqual; 0.1 | x 3 , i - 1 1 | , v 3 , i 1 = sign ( x 3 , i - 1 1 ) &times; 0.1 | x 3 , i - 1 1 | ,
| v 3 , i 2 | &GreaterEqual; 0.1 | x 3 , i - 1 2 | , v 3 , i 2 = sign ( x 3 , i - 1 2 ) &times; 0.1 | x 3 , i - 1 2 | ,
| v 3 , i 3 | &GreaterEqual; 0.1 | x 3 , i - 1 3 | , v 3 , i 3 = sign ( x 3 , i - 1 3 ) &times; 0.1 | x 3 , i - 1 3 | ,
| v 3 , i 4 | &GreaterEqual; 0.1 | x 3 , i - 1 4 | , v 3 , i 4 = sign ( x 3 , i - 1 4 ) &times; 0.1 | x 3 , i - 1 4 | ,
| v 3 , i 5 | &GreaterEqual; 0.1 | x 3 , i - 1 5 | , v 3 , i 5 = sign ( x 3 , i - 1 5 ) &times; 0.1 | x 3 , i - 1 5 | ,
| v 3 , i 6 | &GreaterEqual; 0.1 | x 3 , i - 1 6 | , v 3 , i 6 = sign ( x 3 , i - 1 6 ) &times; 0.1 | x 3 , i - 1 6 | ;
其中,
Figure A200910030062D002515
表示设计向量x3的第一设计分量
Figure A200910030062D002516
第i—1次迭代后的设计值,表示设计向量x3的第二设计分量
Figure A200910030062D002518
第i—1次迭代后的设计值,
Figure A200910030062D002519
表示设计向量x3的第三设计分量
Figure A200910030062D002520
第i—1次迭代后的设计值,
Figure A200910030062D002521
表示设计向量x3的第四设计分量第i—1次迭代后的设计值,
Figure A200910030062D002523
表示设计向量x3的第五设计分量第i—1次迭代后的设计值,
Figure A200910030062D002525
表示设计向量x3的第六设计分量
Figure A200910030062D002526
第i—1次迭代后的设计值;
用修正后的调整量v3,i调整关节的运动学能力设计向量x3,计算第i次迭代后设计向量x3的值x3,i=x3,i-1+v3,i
Figure A200910030062D002527
为误差值e2,i-1相对于设计向量值x3,i-1的负导数对应的符号向量, o 3 , i - 1 2 = sign { - &PartialD; e 2 , i - 1 &PartialD; x 3 , i - 1 } ,
Figure A200910030062D002529
的上标2表示广义综合强度性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
Figure A200910030062D002530
时广义综合强度性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
Figure A200910030062D002531
为误差值e3,i-1相对于设计向量值x3,i-1的偏导数的符号向量, o 3 , i - 1 3 = sign { - &PartialD; e 3 , i - 1 &PartialD; x 3 , i - 1 } ,
Figure A200910030062D002533
的上标3表示广义平均控制能量性能指标的误差,第一下标3表示运动学能力设计向量,第二下标i—1表示在计算时广义平均控制能量性能指标的误差值及运动学能力向量的值为第i—1次迭代后的值;
为误差值e4,i-1相对于设计向量值x3,i-1的偏导数的符号向量, o 3 , i - 1 4 = sign { - &PartialD; e 4 , i - 1 &PartialD; x 3 , i - 1 } ,
Figure A200910030062D00262
的上标4表示广义平均控制时间性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算时广义平均控制时间性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
Figure A200910030062D00264
为误差值e2,i-1在控制律3中的比例系数,
Figure A200910030062D00265
上标2表示广义综合强度性能指标的误差,下标3表示控制律3,并且令 k 3 2 = 1 &times; 10 - 2 ;
Figure A200910030062D00267
为误差值e3,i-1在控制律3中的比例系数,
Figure A200910030062D00268
上标3表示广义平均控制能量性能指标的误差,下标3表示控制律3,并且令 k 3 3 = 0.5 ;
Figure A200910030062D002610
为误差值e4,i-1在控制律4中的比例系数,
Figure A200910030062D002611
上标4表示广义平均控制时间性能指标的误差,下标4表示控制律4,并且令 k 3 4 = 1 ;
利用第一控制律、第二控制律、第三控制律对臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3进行第一次优化设计:
为臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3赋初始设计值,得到向量x1,0、向量x2,0、向量x3,0
为各性能指标期望值
Figure A200910030062D002613
赋第一次多目标优化设计的参考值
Figure A200910030062D002615
得到 J 1,1 * = - 1.3 , J 2,1 * = 0.7 , J 3,1 * = 1.5 , J 4,1 * = 0.35 , 对于
Figure A200910030062D002620
其第一下标1表示工作空间性能表,第二下标1表示第一次多目标优化设计,对于
Figure A200910030062D002621
其第一下标2表示综合强度性能指标,第二下标1表示第一次多目标优化设计,对于
Figure A200910030062D002622
其第一下标3表示平均控制能量指标,第二下标1表示第一次多目标优化设计,对于
Figure A200910030062D002623
其第一下标4表示平均控制时间指标,第二下标1表示第一次多目标优化设计;
由第一次多目标优化设计的参考值
Figure A200910030062D002624
及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:
首先,由第一控制律 v 1,1 = k 1 1 e 1,0 o 1,0 1 + k 1 2 e 2,0 o 1,0 2 + k 1 3 e 3,0 o 1,0 3 + k 1 4 e 4,0 o 1,0 4 及对第一控制律产生的调整量v1,1幅度修正方法:
如果 0 < | v 1 , 1 1 | &le; 0.01 | x 1 , 0 1 | , v 1 , 1 1 = sign ( x 1 , 0 1 ) &times; 0.041 | x 1 , 0 1 | ,
0 < | v 1 , 1 2 | &le; 0.01 | x 1 , 0 2 | , v 1 , 1 2 = sign ( x 1 , 0 2 ) &times; 0.01 | x 1 , 0 2 | ,
如果 | v 1 , 1 1 | &GreaterEqual; 0.04 | x 1 , 0 1 | , v 1 , 1 1 = sign ( x 1 , 0 1 ) &times; 0.04 | x 1 , 0 1 | ,
| v 1 , 1 2 | &GreaterEqual; 0.04 | x 1 , 0 2 | , v 1 , 1 2 = sign ( x 1 , 0 2 ) &times; 0.04 | x 1 , 0 2 | ;
生成对向量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
Figure A200910030062D0027151209QIETU
为误差值e1,0相对于设计向量值x1,0的负导数对应的符号向量, o 1 , 0 1 = sign { - de 1 , 0 dx 1 , 0 } ;
Figure A200910030062D002710
为误差值e2,0相对于设计向量值x1,0的负偏导数对应的符号向量, o 1 , 0 2 = sign { - &PartialD; e 2 , 0 &PartialD; x 1 , 0 } ;
Figure A200910030062D002712
为误差值e3,0相对于设计向量值x1,0的负偏导数对应的符号向量, o 1 , 0 3 = sign { - &PartialD; e 3 , 0 &PartialD; x 1 , 0 } ; 为误差值e4,0相对于设计向量值x1,0的负偏导数对应的符号向量, o 1 , 0 4 = sign { - &PartialD; e 4 , 0 &PartialD; x 1 , 0 } ;
其次,由第二控制律 v 2,1 = k 2 2 e 2,0 o 2,0 2 + k 2 3 e 3,0 o 2,0 3 及对第二控制律产生的调整量v2,1的幅度修正方法:
如果 0 < | v 2 , 1 1 | &le; 0.01 | x 2 , 0 1 | , v 2 , 1 1 = sign ( x 2 , 0 1 ) &times; 0.01 | x 2 , 0 1 | ,
0 < | v 2 , 1 2 | &le; 0.01 | x 2 , 0 2 | , v 2 , 1 2 = sign ( x 2 , 0 2 ) &times; 0.01 | x 2 , 0 2 | ,
0 < | v 2 , 1 3 | &le; 0.01 | x 2 , 0 3 | , v 2 , 1 2 = sign ( x 2 , 0 2 ) &times; 0.01 | x 2 , 0 2 | ,
0 < | v 2 , 1 4 | &le; 0.01 | x 2 , 0 4 | , v 2 , 1 4 = sign ( x 2,0 4 ) &times; 0.01 | x 2 , 0 4 | ;
如果 | v 2 , 1 1 | &GreaterEqual; 0.02 | x 2 , 0 1 | , v 2 , 1 1 = sign ( x 2 , 0 1 ) &times; 0.02 | x 2 , 0 1 | ,
| v 2 , 1 2 | &GreaterEqual; 0.02 | x 2 , 0 2 | , v 2 , 1 2 = sign ( x 2 , 0 2 ) &times; 0.02 | x 2 , 0 2 | ,
| v 2 , 1 3 | &GreaterEqual; 0.02 | x 2 , 0 3 | , v 2 , 1 3 = sign ( x 2 , 0 3 ) &times; 0.02 | x 2 , 0 3 | ,
| v 2 , 1 4 | &GreaterEqual; 0.02 | x 2 , 0 4 | , v 2 , 1 4 = sign ( x 2 , 0 4 ) &times; 0.02 | x 2 , 0 4 | ;
生成对臂厚设计向量x2的第一次迭代的调整值v2,1,用调整值v2,1调整臂厚设计向量x2,得到向量x2的第一次迭代后的值x2,1=x2,0+v2,1;这里,为误差值e2,0相对于设计向量值x2,0的负偏导数对应的符号向量, o 2 , 0 2 = sign { - &PartialD; e 2 , 0 &PartialD; x 2 , 0 } ;
Figure A200910030062D00289
为误差值e3,0相对于设计向量值x2,0的负偏导数对应的符号向量, o 2 , 0 3 = sign { - &PartialD; e 3 , 0 &PartialD; x 2 , 0 } ;
再次,由第三控制律 v 3,1 = k 3 2 e 2,0 o 3,0 2 + k 3 3 e 3,0 o 3,0 3 + k 3 4 e 4,0 o 3,0 4 及对第三控制律产生的调整量v3,1的幅度修正方法:
如果 0 < | v 3 , 1 1 | &le; 0.01 | x 3 , 0 1 | , v 3 , 1 1 = sign ( x 3 , 0 1 ) &times; 0.01 | x 3 , 0 1 | ,
0 < | v 3 , 1 2 | &le; 0.01 | x 3 , 0 2 | , v 3 , 1 2 = sign ( x 3 , 0 2 ) &times; 0.01 | x 3 , 0 2 | ,
0 < | v 3 , 1 3 | &le; 0.01 | x 3 , 0 3 | , v 3 , 1 3 = sign ( x 3 , 0 3 ) &times; 0.01 | x 3 , 0 3 | ,
0 < | v 3 , 1 4 | &le; 0.01 | x 3 , 0 4 | , v 3 , 1 4 = sign ( x 3 , 0 4 ) &times; 0.01 | x 3 , 0 4 | ,
0 < | v 3 , 1 5 | &le; 0.01 | x 3 , 0 5 | , v 3 , 1 5 = sign ( x 3 , 0 5 ) &times; 0.01 | x 3 , 0 5 | ,
0 < | v 3 , 1 6 | &le; 0.01 | x 3 , 0 6 | , v 3 , 1 6 = sign ( x 3 , 0 6 ) &times; 0.01 | x 3 , 0 6 | ,
如果 | v 3 , 1 1 | &GreaterEqual; 0.1 | x 3 , 0 1 | , v 3 , 1 1 = sign ( x 3 , 0 1 ) &times; 0.1 | x 3 , 0 1 | ,
| v 3 , 1 2 | &GreaterEqual; 0.1 | x 3 , 0 2 | , v 3 , 1 2 = sign ( x 3 , 0 2 ) &times; 0.1 | x 3 , 0 2 | ,
| v 3 , 1 3 | &GreaterEqual; 0.1 | x 3 , 0 3 | , v 3 , 1 3 = sign ( x 3 , 0 3 ) &times; 0.1 | x 3 , 0 3 | ,
| v 3 , 1 4 | &GreaterEqual; 0.1 | x 3 , 0 4 | , v 3 , 1 4 = sign ( x 3 , 0 4 ) &times; 0.1 | x 3 , 0 4 | ,
| v 3 , 1 5 | &GreaterEqual; 0.1 | x 3 , 0 5 | , v 3 , 1 5 = sign ( x 3 , 0 5 ) &times; 0.1 | x 3 , 0 5 | ,
| v 3 , 1 6 | &GreaterEqual; 0.1 | x 3 , 0 6 | , v 3 , 1 6 = sign ( x 3 , 0 6 ) &times; 0.1 | x 3 , 0 6 | ,
生成对关节运动学能力设计向量x3的第一次调整值v3,1,用调整值v3,1调整关节运动学能力设计向量x3,得到设计向量x3的第一次迭代后的值x3,1=x3,0+v3,1;这里,为误差值e2,0相对于x3,0的负偏导数对应的符号向量, o 3 , 0 2 = sign { - &PartialD; e 2 , 0 &PartialD; x 3 , 0 } ; 为误差值e3,0相对于设计向量值x3,0的负偏导数对应的符号向量, o 3 , 0 3 = sign { - &PartialD; e 3 , 0 &PartialD; x 3 , 0 } ;
Figure A200910030062D00295
为误差值e4,0相对于设计向量值x3,0的负偏导数对应的符号向量, o 3 , 0 4 = sign { - &PartialD; e 4 , 0 &PartialD; x 3 , 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:首先,由第一控制律 v 1,2 = k 1 1 e 1,1 o 1,1 1 + k 1 2 e 2,1 o 1,1 2 + k 1 3 e 3,1 o 1,1 3 + k 1 4 e 4,1 o 1,1 4 及对第一控制律产生的调整量v1,2幅度修正方法:
如果 0 < | v 1 , 2 1 | &le; 0.01 | x 1 , 1 1 | , v 1 , 2 1 = sign ( x 1 , 1 1 ) &times; 0.01 | x 1 , 1 1 | ,
0 < | v 1 , 2 2 | &le; 0.01 | x 1 , 1 2 | , v 1 , 2 2 = sign ( x 1 , 1 2 ) &times; 0.01 | x 1 , 1 2 | ,
如果 | v 1 , 2 1 | &GreaterEqual; 0.04 | x 1 , 1 1 | , v 1 , 2 1 = sign ( x 1 , 1 1 ) &times; 0.04 | x 1 , 1 1 | ,
| v 1 , 2 2 | &GreaterEqual; 0.04 | x 1 , 1 2 | , v 1 , 2 2 = sign ( x 1 , 1 2 ) &times; 0.04 | x 1 , 1 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
Figure A200910030062D002916
为误差值e1,1相对于设计向量值x1,1的负导数对应的符号向量, o 1 , 1 1 = sign { - de 1 , 1 dx 1 , 1 } ;
Figure A200910030062D00302
为误差值e2,1相对于设计向量值x1,1的负偏导数对应的符号向量, o 1 , 1 2 = sign { - &PartialD; e 2 , 1 &PartialD; x 1 , 1 } ;
Figure A200910030062D00304
为误差值e3,1相对于设计向量值x1,1的负偏导数对应的符号向量, o 1 , 1 3 = sign { - &PartialD; e 3 , 1 &PartialD; x 1 , 1 } ;
Figure A200910030062D00306
为误差值e4,1相对于设计向量值x1,1的负偏导数对应的符号向量, o 1 , 1 4 = sign { - &PartialD; e 4 , 1 &PartialD; x 1 , 1 } ;
其次,由第二控制律 v 2,2 = k 2 2 e 2,1 o 2,1 2 + k 2 3 e 3,1 o 2,1 3 及对第二控制律产生的调整量v2,2的幅度修正方法:
如果 0 < | v 2 , 2 1 | &le; 0.01 | x 2 , 1 1 | , v 2 , 2 1 = sign ( x 2 , 1 1 ) &times; 0.01 | x 2 , 1 1 | ,
0 < | v 2 , 2 2 | &le; 0.01 | x 2 , 1 2 | , v 2 , 2 2 = sign ( x 2 , 1 2 ) &times; 0.01 | x 2 , 1 2 | ,
0 < | v 2 , 2 3 | &le; 0.01 | x 2 , 1 3 | , v 2 , 2 3 = sign ( x 2 , 1 3 ) &times; 0.01 | x 2 , 1 3 | ,
0 < | v 2 , 2 4 | &le; 0.01 | x 2 , 1 4 | , v 2 , 2 4 = sign ( x 2 , 1 4 ) &times; 0.01 | x 2 , 1 4 | ,
如果 | v 2 , 2 1 | &GreaterEqual; 0.02 | x 2 , 1 1 | , v 2 , 2 1 = sign ( x 2 , 1 1 ) &times; 0.02 | x 2 , 1 1 | ,
| v 2 , 2 2 | &GreaterEqual; 0.02 | x 2 , 1 2 | , v 2 , 2 2 = sign ( x 2 , 1 2 ) &times; 0.02 | x 2 , 1 2 | ,
| v 2 , 2 3 | &GreaterEqual; 0.02 | x 2 , 1 3 | , v 2 , 2 3 = sign ( x 2 , 1 3 ) &times; 0.02 | x 2 , 1 3 | ,
| v 2,2 4 | &GreaterEqual; 0.02 | x 2,1 4 | , v 2,2 4 = sign ( x 2,1 4 ) &times; 0.02 | x 2,1 4 | ;
生成设计向量x2进行第二次迭代的调整值 v 2,2 = k 2 2 e 2,1 o 2,1 2 + k 2 3 e 3,1 o 2,1 3 , 再用调整值v2,2调整设计向量x2的值,得到第二次迭代后设计向量x2的值x2,2=x2,1+v2,2;这里,为误差值e2,1相对于设计向量值x2,1的负偏导数对应的符号向量, o 2 , 1 2 = sign { - &PartialD; e 2 , 1 &PartialD; x 2 , 1 } ;
Figure A200910030062D003028
为误差值e3,1相对于设计向量值x2,1的负偏导数对应的符号向量, o 2,1 3 = sign { - &PartialD; e 3 , 1 &PartialD; x 2 , 1 } ;
再次,由第三控制律 v 3,2 = k 3 2 e 2,1 o 3,1 2 + k 3 3 e 3,1 o 3,1 3 + k 3 4 e 4,1 o 3,1 4 及对第三控制律产生的调整量v3,2的幅度修正方法:
如果 0 < | v 3 , 2 1 | &le; 0.01 | x 3 , 1 1 | , v 3 , 2 1 = sign ( x 3 , 1 1 ) &times; 0.01 | x 3 , 1 1 | ,
0 < | v 3 , 2 2 | &le; 0.01 | x 3 , 1 2 | , v 3 , 2 2 = sign ( x 3 , 1 2 ) &times; 0.01 | x 3 , 1 2 | ,
0 < | v 3 , 2 3 | &le; 0.01 | x 3 , 1 3 | , v 3 , 2 3 = sign ( x 3 , 1 3 ) &times; 0.01 | x 3 , 1 3 | ,
0 < | v 3 , 2 4 | &le; 0.01 | x 3 , 1 4 | , v 3 , 2 4 = sign ( x 3 , 1 4 ) &times; 0.01 | x 3 , 1 4 | ,
0 < | v 3 , 2 5 | &le; 0.01 | x 3 , 1 5 | , v 3 , 2 5 = sign ( x 3 , 1 5 ) &times; 0.01 | x 3 , 1 5 | ,
0 < | v 3 , 2 6 | &le; 0.01 | x 3 , 1 6 | , v 3 , 2 6 = sign ( x 3 , 1 6 ) &times; 0.01 | x 3 , 1 6 | ;
如果 | v 3 , 2 1 | &GreaterEqual; 0.1 | x 3 , 1 1 | , v 3 , 2 1 = sign ( x 3 , 1 1 ) &times; 0.1 | x 3 , 1 1 | ,
| v 3 , 1 2 | &GreaterEqual; 0.1 | x 3 , 0 2 | , v 3 , 1 2 = sign ( x 3 , 0 2 ) &times; 0.1 | x 3 , 0 2 | ,
| v 3 , 2 3 | &GreaterEqual; 0.1 | x 3 , 1 3 | , v 3 , 2 3 = sign ( x 3 , 1 3 ) &times; 0.1 | x 3 , 1 3 | ,
| v 3 , 2 4 | &GreaterEqual; 0.1 | x 3 , 1 4 | , v 3 , 2 4 = sign ( x 3 , 1 4 ) &times; 0.1 | x 3 , 1 4 | ,
| v 3 , 2 5 | &GreaterEqual; 0.1 | x 3 , 1 5 | , v 3 , 2 5 = sign ( x 3 , 1 5 ) &times; 0.1 | x 3 , 1 5 | ,
| v 3 , 2 6 | &GreaterEqual; 0.1 | x 3 , 1 6 | , v 3 , 2 6 = sign ( x 3 , 1 6 ) &times; 0.1 | x 3 , 1 6 | ;
生成设计向量x3的第二次迭代的调整值,再用调整值v3,2调整设计向量x3的值,得到第二次迭代后向量x3的值x3,2=x3,1+v3,2;这里,为e2,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 3 , 1 2 = sign { - &PartialD; e 2 , 1 &PartialD; x 3 , 1 } ;
Figure A200910030062D003127
为误差值e3,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 3 , 1 3 = sign { - &PartialD; e 3 , 1 &PartialD; x 3 , 1 } ;
Figure A200910030062D003129
为误差值e4,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 3 , 1 4 = sign { - &PartialD; e 4 , 1 &PartialD; x 3 , 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对各性能指标期望值
Figure A200910030062D00321
的期望值进行第n—1次调整后进行第n次优化设计,令 J 1 , n * = 1.05 &times; J 1 , n - 1 * , J 2 , n * = 1.05 &times; J 2 , n - 1 * , J 3 , n * = 1.05 &times; J 3 , n - 1 * , J 4 , n * = 1.05 &times; J 4 , n - 1 * , n为优化设计的次数,对设计向量x1、x2、x3进行第n次优化设计,重复步骤3.1~步骤3.3。
与现有技术相比,本发明具有如下优点:
1.本发明通过明确多目标优化设计任务: min J 1 ( x 1 ) min J 2 ( x 2 ; x 1 , x 3 ) min J 3 ( x 3 ; x 1 , x 2 ) min J 4 ( x 3 ; x 1 ) s . t &phi; 1 &le; 0 ; &phi; 2 &le; 0 ; &phi; 3 &le; 0 将搬运机器人的机械系统设计、驱动系统设计由上下游设计关系转化为并行设计过程,从而兼顾了各子系统设计对机器人性能产生的影响,为全面优化机器人的工作空间性能、强度性能以及控制性能提供了方法。
2.通过将约束条件与优化目标进行合并转化,得到四个广义多目标优化指标:
Z 1 = max { 0 , J 1 - J 1 * } + &sigma; 1 &Sigma; m = 1 5 max { 0 , &phi; 1 m } 2 Z 2 = max { 0 , J 2 - J 2 * } + &sigma; 2 &Sigma; m = 1 4 max { 0 , &phi; 2 m } 2 Z 3 = max { 0 , J 3 - J 3 * } + &sigma; 3 &Sigma; m = 1 6 max { 0 , &phi; 3 m } 2 Z 4 = max { 0 , J 4 - J 4 * } 从而将多目标多目标优化目标转化为使四个广义性能指标同时趋于零。
3.针对转化后的多目标优化设计问题,提出了一种通过控制方法解决多目标优化问题的新方法。通过
第一控制律: v 1 , i = k 1 1 e 1 , i - 1 o 1 , i - 1 1 + k 1 2 e 2 , i - 1 o 1 , i - 1 2 + k 1 3 e 3 , i - 1 o 1 , i - 1 3 + k 1 4 e 4 , i - 1 o 1 , i - 1 4
第二控制律: v 2 , i = k 2 2 e 2 , i - 1 o 2 , i - 1 2 + k 2 3 e 3 , i - 1 o 2 , i - 1 3
第三控制律: v 3 , i = k 3 2 e 2 , i - 1 o 3 , i - 1 2 + k 3 3 e 3 , i - 1 o 3 , i - 1 3 + k 3 4 e 4 , i - 1 o 3 , i - 1 4 ;
分别建立臂长设计向量x1、臂厚设计向量x2、运动学能力设计向量x3在第i次迭代的初始控制量。
4.通过建立控制律中误差系数的设置原则,实现控制律调整方向的协调。对于三个控制律,误差系数整定原则为:
在第一控制律中,通过系数
Figure A200910030062D00335
的整定,保证在第i次迭代调整x1的设计值时,
Figure A200910030062D00336
对应的调整方向,即使Z1收敛至零的方向作为优先级最高的调整方向;第二级,
Figure A200910030062D00337
对应的调整方向,即使Z2收敛至零的方向作为优先级次高的调整方向;
Figure A200910030062D00338
对应的调整方向,即使Z3、Z4收敛至零的方向作为优先级最低的调整方向,对同处于最低优先级
Figure A200910030062D003310
对应的调整方向,规定
Figure A200910030062D003311
对应的调整方向优先级高于
Figure A200910030062D003312
对应的调整方向。
在第二控制律中,通过系数
Figure A200910030062D003313
的整定,保证在第i次迭代调整x2的设计值时,对应的调整方向,即使Z2收敛至零的方向,作为优先级高的调整方向;对应的调整方向,即使Z3收敛至零的方向,作为优先级低的调整方向。
在第三控制律中,通过系数
Figure A200910030062D00341
的整定,保证在第i次迭代调整x3的设计值时,
Figure A200910030062D00342
对应的调整方向,即使Z3、Z4收敛至零的方向作为高优先级的调整方向,对同处于高优先级
Figure A200910030062D00343
对应的调整方向,规定
Figure A200910030062D00344
对应的调整方向优先级高于
Figure A200910030062D00345
对应的调整方向;
Figure A200910030062D00346
对应的调整方向,即使Z2收敛至零的方向作为优先级低的调整方向。
同时规定,在第一控制律、第二控制律、第三控制律中优先级高的广义性能指标不收敛到零之前,相应的设计变量一直按照该广义性能指标收敛到零的方向调整。当优先级高的广义性能指标收敛到零之后,相应的设计变量按照优先级相对较高的广义性能指标收敛到零的方向调整,依次进行,直到所有广义性能指标都收敛到零。
5.通过设计对三个控制律生成的控制量幅度的调整方法,解决了用控制方法进行多目标优化设计时各广义性能指标的值不收敛到目标值零的问题。
用控制方法进行多目标优化设计时各广义性能指标的值不收敛到目标值零主要由于三种情况引起:
原因一是对设计变量的调整量过大;原因二是对设计变量的调整量过小;原因三是由于对各性能指标的期望值设置不合理。针对原因一、原因二提出控制量幅度的调整方法。
为防止控制量幅度过大或过小提出:
对于第一控制律生成的第i次迭代的调整量的幅度进行修正的方法为:
如果 0 < | v 1 , i 1 | &le; 0.01 | x 1 , i - 1 1 | , v 1 , i 1 = sign ( x 1 , i - 1 1 ) &times; 0.01 | x 1 , i - 1 1 | ,
0 < | v 1 , i 2 | &le; 0.01 | x 1 , i - 1 2 | , v 1 , i 2 = sign ( x 1 , i - 1 2 ) &times; 0.01 | x 1 , i - 1 2 | ,
如果 | v 1 , i 1 | &GreaterEqual; 0.04 | x 1 , i - 1 1 | , v 1 , i 1 = sign ( x 1 , i - 1 1 ) &times; 0.04 | x 1 , i - 1 1 | ,
| v 1 , i 2 | &GreaterEqual; 0.04 | x 1 , i - 1 2 | , v 1 , i 2 = sign ( x 1 , i - 1 2 ) &times; 0.04 | x 1 , i - 1 2 | ;
对于第二控制律生成的第i次迭代的调整量的幅度进行修正的方法为:
如果 0 < | v 2 , i 1 | &le; 0.01 | x 2 , i - 1 1 | , v 2 , i 1 = sign ( x 2 , i - 1 1 ) &times; 0.01 | x 2 , i - 1 1 | ,
0 < | v 2 , i 2 | &le; 0.01 | x 2 , i - 1 2 | , v 2 , i 2 = sign ( x 2 , i - 1 2 ) &times; 0.01 | x 2 , i - 1 2 | ,
0 < | v 2 , i 3 | &le; 0.01 | x 2 , i - 1 3 | , v 2 , i 3 = sign ( x 2 , i - 1 3 ) &times; 0.01 | x 2 , i - 1 3 | ,
0 < | v 2 , i 4 | &le; 0.01 | x 2 , i - 1 4 | , v 2 , i 4 = sign ( x 2 , i - 1 4 ) &times; 0.01 | x 2 , i - 1 4 | ;
如果 | v 2 , i 1 | &GreaterEqual; 0.02 | x 2 , i - 1 1 | , v 2 , i 1 = sign ( x 2 , i - 1 1 ) &times; 0.02 | x 2 , i - 1 1 | ,
| v 2 , i 2 | &GreaterEqual; 0.02 | x 2 , i - 1 2 | , v 2 , i 2 = sign ( x 2 , i - 1 2 ) &times; 0.02 | x 2 , i - 1 2 | ,
| v 2 , i 3 | &GreaterEqual; 0.02 | x 2 , i - 1 3 | , v 2 , i 3 = sign ( x 2 , i - 1 3 ) &times; 0.02 | x 2 , i - 1 3 | ,
| v 2 , i 4 | &GreaterEqual; 0.02 | x 2 , i - 1 4 | , v 2 , i 4 = sign ( x 2 , i - 1 4 ) &times; 0.02 | x 2 , i - 1 4 | ;
对于第三控制律,生成的第i次迭代的调整量的幅度进行修正的方法为:
如果 0 < | v 3 , i 1 | &le; 0.01 | x 3 , i - 1 1 | , v 3 , i 1 = sign ( x 3 , i - 1 1 ) &times; 0.01 | x 3 , i - 1 1 | ,
0 < | v 3 , i 2 | &le; 0.01 | x 3 , i - 1 2 | , v 3 , i 2 = sign ( x 3 , i - 1 2 ) &times; 0.01 | x 3 , i - 1 2 | ,
0 < | v 3 , i 3 | &le; 0.01 | x 3 , i - 1 3 | , v 3 , i 3 = sign ( x 3 , i - 1 3 ) &times; 0.01 | x 3 , i - 1 3 | ,
0 < | v 3 , i 4 | &le; 0.01 | x 3 , i - 1 4 | , v 3 , i 4 = sign ( x 3 , i - 1 4 ) &times; 0.01 | x 3 , i - 1 4 | ,
0 < | v 3 , i 5 | &le; 0.01 | x 3 , i - 1 5 | , v 3 , i 5 = sign ( x 3 , i - 1 5 ) &times; 0.01 | x 3 , i - 1 5 | ,
0 < | v 3 , i 6 | &le; 0.01 | x 3 , i - 1 6 | , v 3 , i 6 = sign ( x 3 , i - 1 6 ) &times; 0.01 | x 3 , i - 1 6 | ;
如果 | v 3 , i 1 | &GreaterEqual; 0.1 | x 3 , i - 1 1 | , v 3 , i 1 = sign ( x 3 , i - 1 1 ) &times; 0.1 | x 3 , i - 1 1 | ,
| v 3 , i 2 | &GreaterEqual; 0.1 | x 3 , i - 1 2 | , v 3 , i 2 = sign ( x 3 , i - 1 2 ) &times; 0.1 | x 3 , i - 1 2 | ,
| v 3 , i 3 | &GreaterEqual; 0.1 | x 3 , i - 1 3 | , v 3 , i 3 = sign ( x 3 , i - 1 3 ) &times; 0.1 | x 3 , i - 1 3 | ,
| v 3 , i 4 | &GreaterEqual; 0.1 | x 3 , i - 1 4 | , v 3 , i 4 = sign ( x 3 , i - 1 4 ) &times; 0.1 | x 3 , i - 1 4 | ,
| v 3 , i 5 | &GreaterEqual; 0.1 | x 3 , i - 1 5 | , v 3 , i 5 = sign ( x 3 , i - 1 5 ) &times; 0.1 | x 3 , i - 1 5 | ,
| v 3 , i 6 | &GreaterEqual; 0.1 | x 3 , i - 1 6 | , v 3 , i 6 = sign ( x 3 , i - 1 6 ) &times; 0.1 | x 3 , i - 1 6 | ;
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=[0.8,0.6]T,x2=[0.1,0.1,0.1,0.1]T,x3=[5,5,5,3,3,3]T
计算初始化设计变量下机械臂各性能为:
J1=—1.2,J2=1.3879,J3=1.6411,J4=0.4393。
结合机械臂初始性能,给定各性能最终优化的次最优指标:
J 1 * = - 1.3 , J 2 * = 0.7 , J 3 * = 1.5 , J 4 * = 0.35 ,
经过24次叠代,各性能都达到各性能可接受的性能值。优化前后各设计变量的变化以及性能指标的变化可通过表1及表2所示。
 
设计变量 初始设计值 最终设计值
臂2长度 0.8 0.845
臂3长度 0.6 0.673
臂2外截面高 0.1 0.086
臂2外截面宽 0.1 0.086
臂3外截面高 0.1 0.081
臂3外截面宽 0.1 0.107
关节1最大角加速度 5 8.26
关节2最大角加速度 5 7.87
关节3最大角加速度 5 8.48
关节1最大角速度 3 4.99
关节2最大角速度 3 4.84
关节3最大角速度 3 4.28
表1  优化设计前后设计变量设计值的变化
 
性能指标Ji 初始性能值 最终性能值
J1 -1.2 -1.346
J2 1.3879 0.642
J3 1.6411 1.4736
J4 0.4393 0.3494
表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所示;由该机械臂运动学方程,可得末端工作点的轨迹为 x 2 + y 2 + ( z - l 1 ) 2 = l 2 2 + l 3 2 + 2 l 2 l 3 cos ( 2 &theta; 2 + &theta; 3 ) ; 设各转角范围设计为-π≤θ1≤π,-π≤θ2≤π,-π≤θ3≤π则机械臂的工作空间是一簇以(0,0,l1)为球心,半径 r = l 2 2 + l 3 2 + 2 l 2 l 3 cos ( 2 &theta; 2 + &theta; 3 ) 的同心球;设其中半径最小的球半径为Rmin,并规定l2≥l3,则Rmin=l2-l3;设半径最大球的半径为Rmax,则Rmax=l2+l3;则J1=λ1Rmin2Rmax=(λ12)l2-(λ12)l3
使用机械臂运动学模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的工作空间性能指标:
J1=λ1Rmin2Rmax=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)各单元在机器人运动时的加速度 a &RightArrow; ai = a &RightArrow; ei + a &RightArrow; ri + a &RightArrow; ki , 其中
Figure A200910030062D00382
为单元i的绝对加速度,
Figure A200910030062D00383
为单元i的牵连加速度,
Figure A200910030062D00384
为单元i的相对加速度,
Figure A200910030062D00385
为单元i的科氏加速度,则惯性力系即为各单元在运动过程中产生的惯性力 F &RightArrow; i = - m i a &RightArrow; ai 的综合作用,mi为单元i的质量,对于第二机械臂(2)各单元的惯性力系在第二关节处简化为主矢
Figure A200910030062D00387
F &RightArrow; 2 I = &Sigma; i = 1 K 2 F &RightArrow; 2 i ; 主矩为
Figure A200910030062D00389
M &OverBar; 2 IO 1 = &Sigma; i = 1 K 2 o 1 i &RightArrow; &times; F &RightArrow; 2 i , 对于第三机械臂(3)各单元的惯性力系在第三关节处简化为主矢 F &RightArrow; 3 I = &Sigma; i = 1 K 3 F &RightArrow; 3 i , 主矩为
Figure A200910030062D003813
M &OverBar; 3 IO 2 = &Sigma; i = 1 K 3 o 2 i &RightArrow; &times; F &RightArrow; 3 i ;
第三,根据对第二机械臂(2)、第三机械臂(3)在机器人运动过程中由各单元所受惯性力组成的惯性力系分别在第三关节及第二关节处简化得到的惯性力主矢与主矩以及质点系的达朗贝尔定理,分别求得关节3及关节2处产生的支反力及支反力偶;
第四,根据其次通过截面法求得机械臂2及3上各单元处的弯矩;
第五,经过分析可知,各机械臂关节处的单元在机械臂运动时产生的弯矩最大,并且机械臂2上关节2处单元的弯矩矢量在Z2轴分量最大,机械臂3上关节3处单元的弯矩矢量在Z3轴分量最大,分别设为M2Zmax及M3Zmax,并且经分析M3Zmax=τ3max、M2Zmax=τ2max;则机械臂运动时,第二机械臂(2)上最大应力 &sigma; 2 Z max = &tau; 2 max W 2 Z , 第三机械臂(3)上的最大应力 &sigma; 3 Z max = &tau; 3 max W 3 Z ; 其中,τ2max、τ3max为运动时各关节驱动电机施加到机械臂上的最大转矩,W2Z、W3Z分别表示机械臂2与机械臂3的截面相对于连杆坐标系2的Z2轴及连杆坐标系3的Z3轴的抗弯截面系数;经计算可知 W 2 Z = b 2 h 2 3 - b 2 e h 2 e 3 6 h 2 , W 3 Z = b 3 h 3 3 - b 3 e h 3 e 3 6 h 3 ; 对于τ2max、τ3ma,根据三自由度机器人机械部分的动力学方程可知:
&tau; 2 = &tau; 2 ( &theta; 2 , &theta; 3 , &theta; . 1 , &theta; . 2 , &theta; . 3 , &theta; . . 2 , &theta; . . 3 , l 2 , l 3 , b 2 , b 2 e , h 2 , h 2 e , b 3 , b 3 e , h 3 , h 3 e ) ,
&tau; 3 = &tau; 3 ( &theta; 2 , &theta; 3 , &theta; . 1 , &theta; . 2 , &theta; . . 2 , &theta; . . 3 , l 2 , l 3 , b 3 , b 3 e , h 3 , h 3 e ) ; 即关节施加到机械臂上的电磁转矩是关节位置、关节角速度、角加速度的值以及机器人的机械参数的非线性函数,而
Figure A200910030062D00395
的值,又取决于各关节电机能提供的最大角速度
Figure A200910030062D00396
及最大角加速度的值(i=1,2,3),因此τ2、τ3是一个非线性有约束的多元函数,其最大值τ2max、τ3max的求解可以通过非线性函数约束条件下求极值的方法获得。
使用由上述五个步骤获得的强度分析模型得到涉及第二机械臂(2)及第三机械臂(3)的综合强度性能指标:
J 2 = ( | &sigma; 2 max - 0.8 [ &sigma; ] | + | &sigma; 3 max - 0.8 [ &sigma; ] | ) / ( 7 &times; 10 7 )
   = f 2 ( l 2 , b 2 , h 2 , b 2 e , h 2 e , l 3 , b 3 , h 3 , b 3 e , h 3 e , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max , &theta; . 3 max ) ,
其中,[σ]为第二机械臂(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)内腔的宽度及高度,
Figure A200910030062D003910
分别为第二关节、第三关节的最大角加速度,分别为第一关节、第二关节、第三关节的最大角速度,7×107为比例系数。
最后,通过通过以下各步骤建立基于机电耦合系统动力学模型及逆动力学控制的系统闭环模型:
第一,通过拉格朗日-欧拉法建立该机器人机械负载部分的动力学方程,其形式为:
&tau; 1 &tau; 2 &tau; 3 = D 11 + I a 1 0 0 0 D 22 + I a 2 D 23 0 D 32 D 33 + I a 3 &theta; . . 1 &theta; . . 2 &theta; . . 3 + 0 0 0 D 211 0 D 233 D 311 D 322 0 &theta; . 1 2 &theta; . 2 2 &theta; . 3 2 ;
+ 2 D 112 0 D 113 0 D 223 0 0 0 0 &theta; . 1 &theta; . 2 &theta; . 2 &theta; . 3 &theta; . 1 &theta; . 3 + 0 D 2 D 3
其中,Di、Dij、Dijk为机械部分动力学方程的系数,这些系数与机械设计参数及机械臂运动位置有关。τi为施加到机械臂i的机械部分的转矩,Iai为机械臂i传动装置的转动惯量,
Figure A200910030062D00403
θi分别为机械臂i所对应关节的瞬时角加速度、角速度及角位移,其中(i=1,2,3)。
在此基础上,设计该机器人机械系统与电机系统不经变速箱而直接连接,并将机械部分动力学模型折算到电机侧,建立起机电耦合系统的动力学模型:
u m 1 u m 2 u m 3 = K 1 D 11 + I a 1 &prime; 0 0 0 K 2 D 22 + I a 2 &prime; K 2 D 23 0 K 3 D 32 K 3 D 33 + I a 3 &prime; &theta; . . 1 &theta; . . 2 &theta; . . 3 + 0 0 0 K 2 D 211 0 K 2 D 233 K 3 D 311 K 3 D 322 0 &theta; . 1 2 &theta; . 2 2 &theta; . 3 2
+ 2 K 1 D 112 0 K 1 D 113 0 K 2 D 223 0 0 0 0 &theta; . 1 &theta; . 2 &theta; . 2 &theta; . 3 &theta; . 1 &theta; . 3 + k e 1 0 0 0 k e 2 0 0 0 k e 3 &theta; . 1 &theta; . 2 &theta; . 3 + 0 K 2 D 2 K 3 D 3
;其中,umi为机械臂i控制电机的电枢电路电压;Ki为机械臂i的机械部分向电机部分折算的系数,Ki=Rmi/kmi
Figure A200910030062D00406
为机械臂i的系统传动装置总转动惯量, I ai &prime; = K i I ai + R mi J mi / k mi , Rmi、kmi、kei、Jmi分别为机械臂i对应控制电机的电枢电路电阻、转矩系数和电势系数和电机轴的转动惯量(i=1,2,3)。
第二,在机电耦合系统的动力学模型的基础上,采用具有偏置的PD控制律及逆动力学控制的策略,最终构成机器人控制系统,最终构成机器人闭环控制系统框图如图2所示,其中,Θd=[θd1,θd2,θd3]T &Theta; . d = [ &theta; . d 1 , &theta; . d 2 , &theta; . d 3 ] T , &Theta; . . d = [ &theta; . . d 1 , &theta; . . d 2 , &theta; . . d 3 ] T , 分别为参考轨迹向量、参考角速度及参考角加速度向量;KD=diag(kd1,kd2,kd3)、KP=diag(kp1,kp2,kp3),分别为控制器微分系数矩阵与比例系数矩阵。
第三,该机器人运动控制的参考轨线采用关节空间中抛物线过渡的线性插值法产生,并且使用机器人各关节的最大运动能力进行规划,以保证任何控制任务在机器人设计的运动能力内以最短的时间完成;各关节的最大运动能力与各关节驱动电机有关,包括各关节的最大角加速度
Figure A200910030062D004010
(单位:rad/s2)以及各关节的最大角速度
Figure A200910030062D00411
(单位:rad/s),在关节期望运动的匀加速运动阶段,各关节以
Figure A200910030062D00412
加速运动,至关节角速度达到
Figure A200910030062D00413
在关节期望运动的匀速运动阶段,各关节以
Figure A200910030062D00414
匀速运动;在关节期望运动的匀减速运动阶段,各关节以
Figure A200910030062D00415
减速运动,至关节角速度达到0;三段期望运动的结束时刻分别设为tai、tbi、tci,对于某些控制任务的期望运动也可能仅由匀加速与匀减速两段组成,该两端期望运动结束时间分别设为tai、tci
第四,由于给定参考输入运动轨线在tai、tbi、tci时刻二阶导数不连续,实际控制轨线与参考轨线存在误差;由闭环控制系统模型可知误差函数为 e . . i + k di e . i + k pi e i = 0 , 该误差函数是一个二阶微分方程,为使误差函数收敛,应通过控制器参数调整保证误差系统为过阻尼或临界阻尼状态,对于每个关节而言,即要求k2 di≥4kpi,(i=1,2,3)。通过上述控制器参数下对闭环控制系统进行仿真可知,该误差在控制过程中完全可忽略不计;
第五,对于一项搬运任务其控制结束时间及所需控制能量的计算方法为:设在基坐标系中搬运任务初始点坐标为(x0,y0,z0),终止点坐标为(xf,yf,zf),根据该机械臂逆运动学模型,计算完成该搬运任务各关节的初始关节角θi0终止关节角θif;根据上述参考轨迹的规划方案,生成各关节完成该搬运任务对应的参考角度轨线θdi(t)、参考角速度轨线和参考角加速度轨线
Figure A200910030062D00418
并分别组成参考轨迹向量Θd(t)、参考角速度向量
Figure A200910030062D00419
及参考角加速度向量
Figure A200910030062D004110
根据具有偏置的PD控制律及逆动力学控制的策略的控制特点,可以认为控制结束时间即为三个关节参考轨迹结束时间,各关节控制过程中实际的角度、角速度、角加速度轨线即为参考角度、角速度、角加速度轨线;因此,该搬运任务的控制时间为tf=tc=max(tc1,tc2,tc3),该搬运任务的控制能量为 W = &Integral; 0 t f | &tau; 1 ( t ) | dt + &Integral; 0 t f | &tau; 2 ( t ) | dt + &Integral; 0 t f | &tau; 3 ( t ) | dt , 其中τi(t)由机械臂机械部分动力学模型及控制任务对应的参考轨迹计算, &tau; i ( &Theta; ( t ) , &Theta; . ( t ) , &Theta; . . ( t ) ) = &tau; i ( &Theta; d ( t ) , &Theta; . d ( t ) , &Theta; . . d ( t ) ) .
使用通过上述五个步骤获得的系统闭环模型得到第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的平均控制能量指标:
J 3 = 1 200 &Sigma; n = 1 200 1 m Ln ( | &theta; 1 n | + | &theta; 2 n | + | &theta; 3 n | ) [ &Integral; 0 t fn | &tau; 1 ( t ) | dt + &Integral; 0 t fn | &tau; 2 ( t ) | dt + &Integral; 0 t fn | &tau; 3 ( t ) | dt ] ,
   = f 3 ( l 1 , R 1 , r 1 , l 2 , b 2 , h 2 , b 2 e , h 2 e , l 3 , b 3 , h 3 , b 3 e , h 3 e , &theta; . . 1 max , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max , &theta; . 3 max )
及平均控制时间指标
J 4 = 1 200 &Sigma; n = 1 200 t fn ( | &theta; 1 n | + | &theta; 2 n | + | &theta; 3 n | ) = f 4 ( l 1 , l 2 , l 3 , &theta; . . 1 max , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max , &theta; . 3 max ) ,
其中,200是指在给定设计要求的工作空间中随机选取400个点作为搬运任务的起止点,由此组成200组搬运任务工作点;n表示第n组搬运任务,mLn表示第n组搬运任务的负载质量,|θ1n|、|θ2n|、|θ3n|分别表示表示完成第n组搬运任务第一关节、第二关节及第三关节的转动角度,τ1(t)、τ2(t)、τ3(t)分别表示完成第n组搬运任务第一关节、第二关节及第三关节在t时刻输出的电磁转矩,tfn表示完成第n组搬运任务的完成时间,R1、r1分别为圆筒形的第一机械臂(1)外半径及内半径,
Figure A200910030062D00424
为第一关节的最大角加速度;
步骤2对工作空间性能指标、综合强度性能指标、平均控制能量指标及平均控制时间指标涉及的参数进行选择性优化,并建立多目标并行优化模型
首先,选择参数l2、l3、b2、h2、b3、h3 &theta; . . 1 max , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max ,
Figure A200910030062D00426
作为设计变量,对
工作空间性能指标
J1=λ1Rmin2Rmax
综合强度性能指标
J2=|σ2zmax-0.8[σ]|+|σ3Zmax-0.8[σ]|,
平均控制能量指标
J 3 = 1 200 &Sigma; n = 1 200 1 m Ln ( | &theta; 1 n | + | &theta; 2 n | + | &theta; 3 n | ) [ &Integral; 0 t fn | &tau; 1 ( t ) | dt + &Integral; 0 t fn | &tau; 2 ( t ) | dt + &Integral; 0 t fn | &tau; 3 ( t ) | dt ] ,
及平均控制时间指标
J 4 = 1 200 &Sigma; n = 1 200 t fn ( | &theta; 1 n | + | &theta; 2 n | + | &theta; 3 n | )
进行同时优化,得到多目标优化设计任务:
min J 1 ( x 1 ) min J 2 ( x 2 ; x 1 , x 3 ) min J 3 ( x 3 ; x 1 , x 2 ) min J 4 ( x 3 ; x 1 ) s . t &phi; 1 &le; 0 ; &phi; 2 &le; 0 ; &phi; 3 &le; 0
其中,x1是由设计变量l2、l3组成的向量, x 1 = [ x 1 1 , x 1 2 ] T = [ l 2 , l 3 ] T , 称之为臂长设计向量,其中,的下标1表示设计向量x1,上标1表示设计向量x1的第一分量,
Figure A200910030062D00434
的下标1表示设计向量x1,上标2表示设计向量x1的第二分量;x2是由设计变量b2、h2、b3、h3组成的向量, x 2 = [ x 2 1 , x 2 2 , x 2 3 , x 2 4 ] T = [ h 2 , b 2 , h 3 , b 3 ] T , 称之为臂的厚度设计向量,其中,
Figure A200910030062D00436
的下标2表示设计向量x2,上标1表示设计向量x2的第一分量,
Figure A200910030062D00437
的下标2表示设计向量x2,上标2表示设计向量x2的第二分量,
Figure A200910030062D00438
的下标2表示设计向量x2,上标3表示设计向量x2的第三分量,
Figure A200910030062D00439
的下标2表示设计向量x2,上标4表示设计向量x2的第四分量;x3是由设计变量 &theta; . . 1 max , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max , &theta; . 3 max 组成的向量, x 3 = [ x 3 1 , x 3 2 , x 3 3 , x 3 4 , x 3 5 , x 3 6 ] T = [ &theta; . . 1 max , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max , &theta; . 3 max ] T 称之为关节的运动学能力设计向量,的下标3表示设计向量x3,上标1表示设计向量x3的第一分量,的下标3表示设计向量x3,上标2表示设计向量x3的第二分量,
Figure A200910030062D004314
的下标3表示设计向量x3,上标3表示设计向量x3的第三分量,
Figure A200910030062D004315
的下标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为第三约束条件向量 &phi; 3 = [ - &theta; . . 1 max , - &theta; . . 2 max , - &theta; . . 3 max , - &theta; . 1 max , - &theta; . 2 max , - &theta; . 3 max ] T ;
其次,将约束条件与工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4进行合并转化,得到广义工作空间性能指标Z1,广义综合强度性能指标Z2,广义平均控制能量指标Z3及广义平均控制时间指标Z4
Z 1 = max { 0 , J 1 - J 1 * } + &sigma; 1 &Sigma; m = 1 5 max { 0 , &phi; 1 m } 2 Z 2 = max { 0 , J 2 - J 2 * } + &sigma; 2 &Sigma; m = 1 4 max { 0 , &phi; 2 m } 2 Z 3 = max { 0 , J 3 - J 3 * } + &sigma; 3 &Sigma; m = 1 6 max { 0 , &phi; 3 m } 2 Z 4 = max { 0 , J 4 - J 4 * }
其中,
Figure A200910030062D00442
分别是工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4的期望值,分别表示第一约束条件向量的第m个元素、第二约束条件向量的第m个元素、第三约束条件向量的第m个元素;σ1为第一罚系数,σ1=1000;σ2为第二罚系数,σ2=1000;σ3为第三罚系数,σ3=1000;
步骤3用控制方法获得多目标优化设计参数
建立第一控制律: v 1 , i = k 1 1 e 1 , i - 1 o 1 , i - 1 1 + k 1 2 e 2 , i - 1 o 1 , i - 1 2 + k 1 3 e 3 , i - 1 o 1 , i - 1 3 + k 1 4 e 4 , i - 1 o 1 , i - 1 4
其中,v1,i为第i次迭代时臂长设计向量x1的调整量, v 1 , i = [ v 1 , i 1 , v 1 , i 2 ] T ,
Figure A200910030062D00446
的第一下标1和上标1表示该调整量是对设计向量x1中的第一设计变量
Figure A200910030062D00447
的调整量,第二下标i表示迭代次数,
Figure A200910030062D00448
的第一下标1和上标2表示该调整量是对设计向量x1中的第二设计变量
Figure A200910030062D00449
的调整量,第二下标i表示迭代次数;
对第一控制律产生的调整量v1,i的调整幅度进行修正:
如果 0 < | v 1 , i 1 | &le; 0.01 | x 1 , i - 1 1 | , v 1 , i 1 = sign ( x 1 , i - 1 1 ) &times; 0.01 | x 1 , i - 1 1 | ,
0 < | v 1 , i 2 | &le; 0.01 | x 1 , i - 1 2 | , v 1 , i 2 = sign ( x 1 , i - 1 2 ) &times; 0.01 | x 1 , i - 1 2 | ,
如果 | v 1 , i 1 | &GreaterEqual; 0.04 | x 1 , i - 1 1 | , v 1 , i 1 = sign ( x 1 , i - 1 1 ) &times; 0.04 | x 1 , i - 1 1 | ,
| v 1 , i 2 | &GreaterEqual; 0.04 | x 1 , i - 1 2 | , v 1 , i 2 = sign ( x 1 , i - 1 2 ) &times; 0.04 | x 1 , i - 1 2 | ,
其中,
Figure A200910030062D004418
表示设计向量x1的第一设计分量
Figure A200910030062D004419
第i—1次迭代后的设计值,
Figure A200910030062D004420
表示设计向量x1的第二设计分量
Figure A200910030062D004421
第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的负导数对应的符号向量, o 1 , i - 1 1 = sign { - de 1 , i - 1 dx 1 , i - 1 } , 的上标1表示广义工作空间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062D00454
时广义工作空间性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062D00455
为误差值e2,i-1相对于设计向量值x1,i-1的负导数对应的符号向量, o 1 , i - 1 2 = sign { - &PartialD; e 2 , i - 1 &PartialD; x 1 , i - 1 } ,
Figure A200910030062D00457
的上标2表示广义综合强度性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062D00458
时广义综合强度性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062D00459
为误差值e3,i-1相对于设计向量值x1,i-1的偏导数的符号向量, o 1 , i - 1 3 = sign { - &PartialD; e 3 , i - 1 &PartialD; x 1 , i - 1 } ,
Figure A200910030062D004511
的上标3表示广义平均控制能量指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算时广义平均控制能量性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e4,i-1相对于设计向量值x1,i-1的偏导数的符号向量, o 1 , i - 1 4 = sign { - &PartialD; e 4 , i - 1 &PartialD; x 1 , i - 1 } ,
Figure A200910030062D004515
的上标4表示广义平均控制时间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062D004516
时广义平均控制时间指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
为误差值e1,i-1在控制律1中的比例系数,
Figure A200910030062D004518
上标1表示广义工作空间性能指标的误差,下标1表示控制律1,并且令 k 1 1 = 1 ;
为误差值e2,i-1在控制律1中的比例系数,
Figure A200910030062D00463
上标2表示广义综合强度性能指标的误差,下标1表示控制律1,并且令 k 1 2 = 1 &times; 10 - 2 ;
Figure A200910030062D00465
为误差值e3,i-1在控制律1中的比例系数,
Figure A200910030062D00466
上标3表示广义平均控制能量性能指标的误差,下标1表示控制律1,并且令 k 1 3 = 5 &times; 10 - 4 ;
Figure A200910030062D00468
为误差值e4,i-1在控制律1中的比例系数,
Figure A200910030062D00469
上标4表示广义平均控制时间性能指标的误差,下标1表示控制律1,并且令 k 1 4 = 1 &times; 10 - 4 ;
建立第二控制律: v 2 , i = k 2 2 e 2 , i - 1 o 2 , i - 1 2 + k 2 4 e 3 , i - 1 o 2 , i - 1 3
其中,v2,i为第i次迭代时臂厚设计向量x2的调整量, v 2 , i = [ v 2 , i 1 , v 2 , i 2 , v 2 , i 3 , v 2 , i 4 ] T ,
Figure A200910030062D004613
的第一下标2和上标1表示该调整量是对设计向量x2中的第一设计分量
Figure A200910030062D0046153840QIETU
的调整量,第二下标i表示迭代次数,的第一下标2和上标2表示该调整量是对设计向量x2中的第二设计分量
Figure A200910030062D004615
的调整量,第二下标i表示迭代次数,
Figure A200910030062D004616
的第一下标2和上标3表示该调整量是对设计向量x2中的第三设计分量的调整量,第二下标i表示迭代次数,
Figure A200910030062D004618
的第一下标2和上标4表示该调整量是对设计向量x2中的第四设计分量
Figure A200910030062D004619
的调整量,第二下标i表示迭代次数;
对第二控制律产生的调整量v2,i的调整幅度进行修正:
如果 0 < | v 2 , i 1 | &le; 0.01 | x 2 , i - 1 1 | , v 2 , i 1 = sign ( x 2 , i - 1 1 ) &times; 0.01 | x 2 , i - 1 1 | ,
0 < | v 2 , i 2 | &le; 0.01 | x 2 , i - 1 2 | , v 2 , i 2 = sign ( x 2 , i - 1 2 ) &times; 0.01 | x 2 , i - 1 2 | ,
0 < | v 2 , i 3 | &le; 0.01 | x 2 , i - 1 3 | , v 2 , i 3 = sign ( x 2 , i - 1 3 ) &times; 0.01 | x 2 , i - 1 3 | ,
0 < | v 2 , i 4 | &le; 0.01 | x 2 , i - 1 4 | , v 2 , i 4 = sign ( x 2 , i - 1 4 ) &times; 0.01 | x 2 , i - 1 4 | ;
如果 | v 2 , i 1 | &GreaterEqual; 0.02 | x 2 , i - 1 1 | , v 2 , i 1 = sign ( x 2 , i - 1 1 ) &times; 0.02 | x 2 , i - 1 1 | ,
| v 2 , i 2 | &GreaterEqual; 0.02 | x 2 , i - 1 2 | , v 2 , i 2 = sign ( x 2 , i - 1 2 ) &times; 0.02 | x 2 , i - 1 2 | ,
| v 2 , i 3 | &GreaterEqual; 0.02 | x 2 , i - 1 3 | , v 2 , i 3 = sign ( x 2 , i - 1 3 ) &times; 0.02 | x 2 , i - 1 3 | ,
| v 2 , i 4 | &GreaterEqual; 0.02 | x 2 , i - 1 4 | , v 2 , i 4 = sign ( x 2 , i - 1 4 ) &times; 0.02 | x 2 , i - 1 4 | ;
其中,
Figure A200910030062D004636
表示设计向量x2的第一设计分量
Figure A200910030062D004637
第i—1次迭代后的设计值,
Figure A200910030062D004638
表示设计向量x2的第二设计分量
Figure A200910030062D00471
第i—1次迭代后的设计值,
Figure A200910030062D00472
表示设计向量x2的第三设计分量
Figure A200910030062D00473
第i—1次迭代后的设计值,
Figure A200910030062D00474
表示设计向量x2的第四设计分量
Figure A200910030062D00475
第i—1次迭代后的设计值;
用修正后的调整值v2,i调整臂厚设计向量,得到第i次迭代后设计向量x2的值x3,i=x2,i-1+v2,i
为误差值e2,i-1相对于设计向量值x2,i-1的负导数对应的符号向量, o 2 , i - 1 2 = sign { - &PartialD; e 2 , i - 1 &PartialD; x 2 , i - 1 } ,
Figure A200910030062D00478
的上标2表示广义综合强度性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
Figure A200910030062D00479
时广义综合强度性能指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x2,i-1的偏导数的符号向量, o 2 , i - 1 3 = sign { - &PartialD; e 3 , i - 1 &PartialD; x 2 , i - 1 } ,
Figure A200910030062D004712
的上标3表示广义平均控制能量性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
Figure A200910030062D004713
时广义平均控制能量指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
Figure A200910030062D004714
为误差e2,i-1在控制律2中的比例系数,上标2表示广义综合强度性能指标的误差,下标2表示控制律2,并且令 k 2 2 = 1 ;
Figure A200910030062D004717
为误差e3,i-1在控制律2中的比例系数,
Figure A200910030062D004718
上标3表示广义平均控制能量性能指标的误差,下标2表示控制律1,并且令 k 2 3 = 1 &times; 10 - 2 ;
建立第三控制律: v 3 , i = k 3 2 e 2 , i - 1 o 3 , i - 1 2 + k 3 3 e 3 , i - 1 o 3 , i - 1 3 + k 3 4 e 4 , i - 1 o 3 , i - 1 4
其中,v3,i为第i次迭代时关节运动学能力设计向量x3的调整量, v 3 , i = [ v 3 , i 1 , v 3 , i 2 , v 3 , i 3 , v 3 , i 4 , v 3 , i 5 , v 3 , i 6 ] T ,
Figure A200910030062D004722
的第一下标3和上标1表示该调整量是对设计向量x3中的第一设计分量
Figure A200910030062D004723
的调整量,第二下标i表示迭代次数,
Figure A200910030062D004724
的第一下标3和上标2表示该调整量是对设计向量x3中的第二个设计分量
Figure A200910030062D004725
的调整量,第二下标i表示迭代次数,
Figure A200910030062D004726
的第一下标3和上标3表示该调整量是对设计向量x3中的第三设计分量
Figure A200910030062D004727
的调整量,第二下标i表示迭代次数,
Figure A200910030062D004728
的第一下标3和上标4表示该调整量是对设计向量x3中的第四设计分量
Figure A200910030062D004729
的调整量,第二下标i表示迭代次数;
Figure A200910030062D00481
的第一下标3和上标5表示该调整量是对设计向量x3中的第五设计分量的调整量,第二下标i表示迭代次数;
Figure A200910030062D00483
的第一下标3和上标6表示该调整量是对设计向量x3中的第六设计分量
Figure A200910030062D00484
的调整量,第二下标i表示迭代次数;
对第三控制律产生的调整量v3,i的调整幅度进行修正:
如果 0 < | v 3 , i 1 | &le; 0.01 | x 3 , i - 1 1 | , v 3 , i 1 = sign ( x 3 , i - 1 1 ) &times; 0.01 | x 3 , i - 1 1 | ,
0 < | v 3 , i 2 | &le; 0.01 | x 3 , i - 1 2 | , v 3 , i 2 = sign ( x 3 , i - 1 2 ) &times; 0.01 | x 3 , i - 1 2 | ,
0 < | v 3 , i 3 | &le; 0.01 | x 3 , i - 1 3 | , v 3 , i 3 = sign ( x 3 , i - 1 3 ) &times; 0.01 | x 3 , i - 1 3 | ,
0 < | v 3 , i 4 | &le; 0.01 | x 3 , i - 1 4 | , v 3 , i 4 = sign ( x 3 , i - 1 4 ) &times; 0.01 | x 3 , i - 1 4 | ,
0 < | v 3 , i 5 | &le; 0.01 | x 3 , i - 1 5 | , v 3 , i 5 = sign ( x 3 , i - 1 5 ) &times; 0.01 | x 3 , i - 1 5 | ,
0 < | v 3 , i 6 | &le; 0.01 | x 3 , i - 1 6 | , v 3 , i 6 = sign ( x 3 , i - 1 6 ) &times; 0.01 | x 3 , i - 1 6 | ;
如果 | v 3 , i 1 | &GreaterEqual; 0.1 | x 3 , i - 1 1 | , v 3 , i 1 = sign ( x 3 , i - 1 1 ) &times; 0.1 | x 3 , i - 1 1 | ,
| v 3 , i 2 | &GreaterEqual; 0.1 | x 3 , i - 1 2 | , v 3 , i 2 = sign ( x 3 , i - 1 2 ) &times; 0.1 | x 3 , i - 1 2 | ,
| v 3 , i 3 | &GreaterEqual; 0.1 | x 3 , i - 1 3 | , v 3 , i 3 = sign ( x 3 , i - 1 3 ) &times; 0.1 | x 3 , i - 1 3 | ,
| v 3 , i 4 | &GreaterEqual; 0.1 | x 3 , i - 1 4 | , v 3 , i 4 = sign ( x 3 , i - 1 4 ) &times; 0.1 | x 3 , i - 1 4 | ,
| v 3 , i 5 | &GreaterEqual; 0.1 | x 3 , i - 1 5 | , v 3 , i 5 = sign ( x 3 , i - 1 5 ) &times; 0.1 | x 3 , i - 1 5 | ,
| v 3 , i 6 | &GreaterEqual; 0.1 | x 3 , i - 1 6 | , v 3 , i 6 = sign ( x 3 , i - 1 6 ) &times; 0.1 | x 3 , i - 1 6 | ;
其中,
Figure A200910030062D004829
表示设计向量x3的第一设计分量
Figure A200910030062D004830
第i—1次迭代后的设计值,
Figure A200910030062D004831
表示设计向量x3的第二设计分量第i—1次迭代后的设计值,
Figure A200910030062D004833
表示设计向量x3的第三设计分量
Figure A200910030062D004834
第i—1次迭代后的设计值,
Figure A200910030062D004835
表示设计向量x3的第四设计分量
Figure A200910030062D004836
第i—1次迭代后的设计值,
Figure A200910030062D004837
表示设计向量x3的第五设计分量第i—1次迭代后的设计值,
Figure A200910030062D004839
表示设计向量x3的第六设计分量
Figure A200910030062D004840
第i—1次迭代后的设计值;
用修正后的调整量v3,i调整关节的运动学能力设计向量x3,计算第i次迭代后设计向量x3的值x3,i=x3,i-1+v3,i
Figure A200910030062D00491
为误差值e2,i-1相对于设计向量值x3,i-1的负导数对应的符号向量, o 3 , i - 1 2 = sign { - &PartialD; e 2 , i - 1 &PartialD; x 3 , i - 1 } ,
Figure A200910030062D00493
的上标2表示广义综合强度性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
Figure A200910030062D00494
时广义综合强度性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
为误差值e3,i-1相对于设计向量值x3,i-1的偏导数的符号向量, o 3 , i - 1 3 = sign { - &PartialD; e 3 , i - 1 &PartialD; x 3 , i - 1 } ,
Figure A200910030062D00497
的上标3表示广义平均控制能量性能指标的误差,第一下标3表示运动学能力设计向量,第二下标i—1表示在计算
Figure A200910030062D00498
时广义平均控制能量性能指标的误差值及运动学能力向量的值为第i—1次迭代后的值;
Figure A200910030062D00499
为误差值e4,i-1相对于设计向量值x3,i-1的偏导数的符号向量, o 3 , i - 1 4 = sign { - &PartialD; e 4 , i - 1 &PartialD; x 3 , i - 1 } , 的上标4表示广义平均控制时间性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
Figure A200910030062D004912
时广义平均控制时间性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
Figure A200910030062D004913
为误差值e2,i-1在控制律3中的比例系数,
Figure A200910030062D004914
上标2表示广义综合强度性能指标的误差,下标3表示控制律3,并且令 k 3 2 = 1 &times; 10 - 2 ;
Figure A200910030062D004916
为误差值e3,i-1在控制律3中的比例系数,
Figure A200910030062D004917
上标3表示广义平均控制能量性能指标的误差,下标3表示控制律3,并且令 k 3 3 = 0.5 ;
Figure A200910030062D004919
为误差值e4,i-1在控制律4中的比例系数,
Figure A200910030062D004920
上标4表示广义平均控制时间性能指标的误差,下标4表示控制律4,并且令 k 3 4 = 1 ;
利用第一控制律、第二控制律、第三控制律对臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3进行第一次优化设计:
为臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3赋初始设计值,得到向量x1,0、向量x2,0、向量x3,0
为各性能指标期望值
Figure A200910030062D004922
赋第一次多目标优化设计的参考值
Figure A200910030062D004923
Figure A200910030062D004924
得到 J 1 , 1 * = - 1.3 , J 2,1 * = 0.7 , J 3,1 * = 1.5 , J 4,1 * = 0.35 , 对于
Figure A200910030062D004929
其第一下标1表示工作空间性能表,第二下标1表示第一次多目标优化设计,对于
Figure A200910030062D00501
其第一下标2表示综合强度性能指标,第二下标1表示第一次多目标优化设计,对于其第一下标3表示平均控制能量指标,第二下标1表示第一次多目标优化设计,对于
Figure A200910030062D00503
其第一下标4表示平均控制时间指标,第二下标1表示第一次多目标优化设计;
由第一次多目标优化设计的参考值
Figure A200910030062D00504
及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:
首先,由第一控制律 v 1 , 1 = k 1 1 e 1 , 0 o 1 , 0 1 + k 1 2 e 2 , 0 o 1 , 0 2 + k 1 3 e 3 , 0 o 1 , 0 3 + k 1 4 e 4 , 0 o 1 , 0 4 及对第一控制律产生的调整量v1,1幅度修正方法:
如果 0 < | v 1 , 1 1 | &le; 0.01 | x 1 , 0 1 | , v 1 , 1 1 = sign ( x 1 , 0 1 ) &times; 0.01 | x 1 , 0 1 | ,
0 < | v 1 , 1 2 | &le; 0.01 | x 1 , 0 2 | , v 1 , 1 2 = sign ( x 1 , 0 2 ) &times; 0.01 | x 1 , 0 2 | ,
如果 | v 1 , 1 1 | &GreaterEqual; 0.04 | x 1 , 0 1 | , v 1 , 1 1 = sign ( x 1 , 0 1 ) &times; 0.04 | x 1 , 0 1 | ,
| v 1 , 1 2 | &GreaterEqual; 0.04 | x 1 , 0 2 | , v 1 , 1 2 = sign ( x 1 , 0 2 ) &times; 0.04 | x 1 , 0 2 | ;
生成对向量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
Figure A200910030062D005014
为误差值e1,0相对于设计向量值x1,0的负导数对应的符号向量, o 1 , 0 1 = sign { - de 1 , 0 dx 1 , 0 } ,
Figure A200910030062D005016
为误差值e2,0相对于设计向量值x1,0的负偏导数对应的符号向量, o 1 , 0 2 = sign { - &PartialD; e 2 , 0 &PartialD; x 1 , 0 } ;
Figure A200910030062D005018
为误差值e3,0相对于设计向量值x1,0的负偏导数对应的符号向量, o 1 , 0 3 = sign { - &PartialD; e 3 , 0 &PartialD; x 1 , 0 } ;
Figure A200910030062D00512
为误差值e4,0相对于设计向量值x1,0的负偏导数对应的符号向量, o 1 , 0 4 = sign { - &PartialD; e 4 , 0 &PartialD; x 1 , 0 } ;
其次,由第二控制律 v 2,1 = k 2 2 e 2,0 o 2,0 2 + k 2 3 e 3,0 o 2,0 3 及对第二控制律产生的调整量v2,1的幅度修正方法:
如果 0 < | v 2 , 1 1 | &le; 0.01 | x 2 , 0 1 | , v 2 , 1 1 = sign ( x 2 , 0 1 ) &times; 0.01 | x 2 , 0 1 | ,
0 < | v 2 , 1 2 | &le; 0.01 | x 2 , 0 2 | , v 2 , 1 2 = sign ( x 2 , 0 2 ) &times; 0.01 | x 2 , 0 2 | ,
0 < | v 2 , 1 3 | &le; 0.01 | x 2 , 0 3 | , v 2 , 1 3 = sign ( x 2 , 0 3 ) &times; 0.01 | x 2 , 0 3 | ,
0 < | v 2 , 1 4 | &le; 0.01 | x 2 , 0 4 | , v 2 , 1 4 = sign ( x 2 , 0 4 ) &times; 0.01 | x 2 , 0 4 | ;
如果 | v 2 , 1 1 | &GreaterEqual; 0.02 | x 2 , 0 1 | , v 2 , 1 1 = sign ( x 2 , 0 1 ) &times; 0.02 | x 2 , 0 1 | ,
| v 2 , 1 2 | &GreaterEqual; 0.02 | x 2 , 0 2 | , v 2 , 1 2 = sign ( x 2 , 0 2 ) &times; 0.02 | x 2 , 0 2 | ,
| v 2 , 1 3 | &GreaterEqual; 0.02 | x 2 , 0 3 | , v 2 , 1 3 = sign ( x 2 , 0 3 ) &times; 0.02 | x 2 , 0 3 | ,
| v 2 , 1 4 | &GreaterEqual; 0.02 | x 2 , 0 4 | , v 2 , 1 4 = sign ( x 2 , 0 4 ) &times; 0.02 | x 2 , 0 4 | ;
生成对臂厚设计向量x2的第一次迭代的调整值v2,1,用调整值v2,1调整臂厚设计向量x2,得到向量x2的第一次迭代后的值x2,1=x2,0+v2,1;这里,
Figure A200910030062D005121
为误差值e2,0相对于设计向量值x2,0的负偏导数对应的符号向量, o 2 , 0 2 = sign { - &PartialD; e 2 , 0 &PartialD; x 2 , 0 } ;
Figure A200910030062D005123
为误差值e3,0相对于设计向量值x2,0的负偏导数对应的符号向量, o 2 , 0 3 = sign { - &PartialD; e 3 , 0 &PartialD; x 2 , 0 } ;
再次,由第三控制律 v 3,1 = k 3 2 e 2,0 o 3,0 2 + k 3 3 e 3,0 o 3,0 3 + k 3 4 e 4,0 o 3,0 4 及对第三控制律产生的调整量v3,1的幅度修正方法:
如果 0 < | v 3 , 1 1 | &le; 0.01 | x 3 , 0 1 | , v 3 , 1 1 = sign ( x 3 , 0 1 ) &times; 0.01 | x 3 , 0 1 | ,
0 < | v 3 , 1 2 | &le; 0.01 | x 3 , 0 2 | , v 3 , 1 2 = sign ( x 3 , 0 2 ) &times; 0.01 | x 3 , 0 2 | ,
0 < | v 3 , 1 3 | &le; 0.01 | x 3 , 0 3 | , v 3 , 1 3 = sign ( x 3 , 0 3 ) &times; 0.01 | x 3 , 0 3 | ,
0 < | v 3 , 1 4 | &le; 0.01 | x 3 , 0 4 | , v 3 , 1 4 = sign ( x 3 , 0 4 ) &times; 0.01 | x 3 , 0 4 | ,
0 < | v 3 , 1 5 | &le; 0.01 | x 3 , 0 5 | , v 3 , 1 5 = sign ( x 3 , 0 5 ) &times; 0.01 | x 3 , 0 5 | ,
0 < | v 3 , 1 6 | &le; 0.01 | x 3 , 0 6 | , v 3 , 1 6 = sign ( x 3 , 0 6 ) &times; 0.01 | x 3 , 0 6 | ;
如果 | v 3 , 1 1 | &GreaterEqual; 0.1 | x 3 , 0 1 | , v 3 , 1 1 = sign ( x 3 , 0 1 ) &times; 0.1 | x 3 , 0 1 | ,
| v 3 , 1 2 | &GreaterEqual; 0.1 | x 3 , 0 2 | , v 3 , 1 2 = sign ( x 3 , 0 2 ) &times; 0.1 | x 3 , 0 2 | ,
| v 3 , 1 3 | &GreaterEqual; 0.1 | x 3 , 0 3 | , v 3 , 1 3 = sign ( x 3 , 0 3 ) &times; 0.1 | x 3 , 0 3 | ,
| v 3 , 1 4 | &GreaterEqual; 0.1 | x 3 , 0 4 | , v 3 , 1 4 = sign ( x 3 , 0 4 ) &times; 0.1 | x 3 , 0 4 | ,
| v 3 , 1 5 | &GreaterEqual; 0.1 | x 3 , 0 5 | , v 3 , 1 5 = sign ( x 3 , 0 5 ) &times; 0.1 | x 3 , 0 5 | ,
| v 3 , 1 6 | &GreaterEqual; 0.1 | x 3 , 0 6 | , v 3 , 1 6 = sign ( x 3 , 0 6 ) &times; 0.1 | x 3 , 0 6 | ;
生成对关节运动学能力设计向量x3的第一次调整值v3,1,用调整值v3,1调整关节运动学能力设计向量x3,得到设计向量x3的第一次迭代后的值x3,1=x3,0+v3,1;这里,
Figure A200910030062D005219
为误差值e2,0相对于x3,0的负偏导数对应的符号向量, o 3 , 0 2 = sign { - &PartialD; e 2 , 0 &PartialD; x 3 , 0 } ; 为误差值e3,0相对于设计向量值x3,0的负偏导数对应的符号向量, o 3 , 0 3 = sign { - &PartialD; e 3 , 0 &PartialD; x 3 , 0 } ; 为误差值e4,0相对于设计向量值x3,0的负偏导数对应的符号向量, o 3 , 0 4 = sign { - &PartialD; e 4 , 0 &PartialD; x 3 , 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:
首先,由第一控制律 v 1,2 = k 1 1 e 1,1 o 1,1 1 + k 1 2 e 2,1 o 1,1 2 + k 1 3 e 3,1 o 1,1 3 + k 1 4 e 4,1 o 1,1 4 及对第一控制律产生的调整量v1,2幅度修正方法:
如果 0 < | v 1 , 2 1 | &le; 0.01 | x 1 , 1 1 | , v 1 , 2 1 = sign ( x 1 , 1 1 ) &times; 0.01 | x 1 , 1 1 | ,
0 < | v 1 , 2 2 | &le; 0.01 | x 1 , 1 2 | , v 1 , 2 2 = sign ( x 1 , 1 2 ) &times; 0.01 | x 1 , 1 2 | ,
如果 | v 1 , 2 1 | &GreaterEqual; 0.04 | x 1 , 1 1 | , v 1 , 2 1 = sign ( x 1 , 1 1 ) &times; 0.04 | x 1 , 1 1 | ,
| v 1 , 2 2 | &GreaterEqual; 0.04 | x 1 , 1 2 | , v 1 , 2 2 = sign ( x 1 , 1 2 ) &times; 0.04 | x 1 , 1 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
Figure A200910030062D00537
为误差值e1,1相对于设计向量值x1,1的负导数对应的符号向量, o 1 , 1 1 = sign { - de 1 , 1 dx 1 , 1 } ;
Figure A200910030062D00539
为误差值e2,1相对于设计向量值x1,1的负偏导数对应的符号向量, o 1 , 1 2 = sign { - &PartialD; e 2 , 1 &PartialD; x 1 , 1 } ;
Figure A200910030062D005311
为误差值e3,1相对于设计向量值x1,1的负偏导数对应的符号向量, o 1 , 1 3 = sign { - &PartialD; e 3 , 1 &PartialD; x 1 , 1 } ; 为误差值e4,1相对于设计向量值x1,1的负偏导数对应的符号向量, o 1 , 1 4 = sign { - &PartialD; e 4 , 1 &PartialD; x 1 , 1 } ;
其次,由第二控制律 v 2,2 = k 2 2 e 2,1 o 2,1 2 + k 2 3 e 3,1 o 2,1 3 及对第二控制律产生的调整量v2,2的幅度修正方法:
如果 0 < | v 2 , 2 1 | &le; 0.01 | x 2 , 1 1 | , v 2 , 2 1 = sign ( x 2 , 1 1 ) &times; 0.01 | x 2 , 1 1 | ,
0 < | v 2 , 2 2 | &le; 0.01 | x 2 , 1 2 | , v 2 , 2 2 = sign ( x 2 , 1 2 ) &times; 0.01 | x 2 , 1 2 | ,
0 < | v 2 , 2 3 | &le; 0.01 | x 2 , 1 3 | , v 2 , 2 3 = sign ( x 2 , 1 3 ) &times; 0.01 | x 2 , 1 3 | ,
0 < | v 2 , 2 4 | &le; 0.01 | x 2 , 1 4 | , v 2 , 2 4 = sign ( x 2 , 1 4 ) &times; 0.01 | x 2 , 1 4 | ,
如果 | v 2 , 2 1 | &GreaterEqual; 0.02 | x 2 , 1 1 | , v 2 , 2 1 = sign ( x 2 , 1 1 ) &times; 0.02 | x 2 , 1 1 | ,
| v 2 , 2 2 | &GreaterEqual; 0.02 | x 2 , 1 2 | , v 2 , 2 2 = sign ( x 2 , 1 2 ) &times; 0.02 | x 2 , 1 2 | ,
| v 2 , 2 3 | &GreaterEqual; 0.02 | x 2 , 1 3 | , v 2 , 2 3 = sign ( x 2 , 1 3 ) &times; 0.02 | x 2 , 1 3 | ,
| v 2 , 2 4 | &GreaterEqual; 0.02 | x 2 , 1 4 | , v 2 , 2 4 = sign ( x 2 , 1 4 ) &times; 0.02 | x 2 , 1 4 | ;
生成设计向量x2进行第二次迭代的调整值 v 2,2 = k 2 2 e 2,1 o 2,1 2 + k 2 3 e 3,1 o 2,1 3 , 再用调整值v2,2调整设计向量x2的值,得到第二次迭代后设计向量x2的值x2,2=x2,1+v2,2;这里,
Figure A200910030062D00544
为误差值e2,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 2 , 1 2 = sign { - &PartialD; e 2 , 1 &PartialD; x 2 , 1 } ;
Figure A200910030062D00546
为误差值e3,1相对于设计向量值x2,1的负偏导数对应的符号向量, o 2 , 1 3 = sign { - &PartialD; e 3 , 1 &PartialD; x 2 , 1 } ;
再次,由第三控制律 v 3,2 = k 3 2 e 2,1 o 3,1 2 + k 3 3 e 3,1 o 3,1 3 + k 3 4 e 4,1 o 3,1 4 及对第三控制律产生的调整量v3,2的幅度修正方法:
如果 0 < | v 3 , 2 1 | &le; 0.01 | x 3 , 1 1 | , v 3 , 2 1 = sign ( x 3 , 1 1 ) &times; 0.01 | x 3 , 1 1 | ,
0 < | v 3 , 2 2 | &le; 0.01 | x 3 , 1 2 | , v 3 , 2 2 = sign ( x 3 , 1 2 ) &times; 0.01 | x 3 , 1 2 | ,
0 < | v 3 , 2 3 | &le; 0.01 | x 3 , 1 3 | , v 3 , 2 3 = sign ( x 3 , 1 3 ) &times; 0.01 | x 3 , 1 3 | ,
0 < | v 3 , 2 4 | &le; 0.01 | x 3 , 1 4 | , v 3 , 2 4 = sign ( x 3 , 1 4 ) &times; 0.01 | x 3 , 1 4 | ,
0 < | v 3 , 2 5 | &le; 0.01 | x 3 , 1 5 | , v 3 , 2 5 = sign ( x 3 , 1 5 ) &times; 0.01 | x 3 , 1 5 | ,
0 < | v 3 , 2 6 | &le; 0.01 | x 3 , 1 6 | , v 3 , 2 6 = sign ( x 3 , 1 6 ) &times; 0.01 | x 3 , 1 6 | ;
如果 | v 3 , 2 1 | &GreaterEqual; 0.1 | x 3 , 1 1 | , v 3 , 2 1 = sign ( x 3 , 1 1 ) &times; 0.1 | x 3 , 1 1 | ,
| v 3 , 1 2 | &GreaterEqual; 0.1 | x 3 , 0 2 | , v 3 , 1 2 = sign ( x 3 , 0 2 ) &times; 0.1 | x 3 , 0 2 | ,
| v 3 , 2 3 | &GreaterEqual; 0.1 | x 3 , 1 3 | , v 3 , 2 3 = sign ( x 3 , 1 3 ) &times; 0.1 | x 3 , 1 3 | ,
| v 3 , 2 4 | &GreaterEqual; 0.1 | x 3 , 1 4 | , v 3 , 2 4 = sign ( x 3 , 1 4 ) &times; 0.1 | x 3 , 1 4 | ,
| v 3 , 2 5 | &GreaterEqual; 0.1 | x 3 , 1 5 | , v 3 , 2 5 = sign ( x 3 , 1 5 ) &times; 0.1 | x 3 , 1 5 | ,
| v 3 , 2 6 | &GreaterEqual; 0.1 | x 3 , 1 6 | , v 3 , 2 6 = sign ( x 3 , 1 6 ) &times; 0.1 | x 3 , 1 6 | ;
生成设计向量x3的第二次迭代的调整值,再用调整值v3,2调整设计向量x3的值,得到第二次迭代后向量x3的值x3,2=x3,1+v3,2;这里,
Figure A200910030062D005433
为e2,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 3 , 1 2 = sign { - &PartialD; e 2 , 1 &PartialD; x 3 , 1 } ;
Figure A200910030062D005435
为误差值e3,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 3 , 1 3 = sign { - &PartialD; e 3 , 1 &PartialD; x 3 , 1 } ;
Figure A200910030062D00552
为误差值e4,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 3 , 1 4 = sign { - &PartialD; e 4 , 1 &PartialD; x 3 , 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对各性能指标期望值
Figure A200910030062D00554
的期望值进行第n—1次调整后进行第n次优化设计,令 J 1 , n * = 1.05 &times; J 1 , n - 1 * , J 2 , n * = 1.05 &times; J 2 , n - 1 * , J 3 , n * = 1.05 &times; J 3 , n - 1 * , J 4 , n * = 1.05 &times; J 4 , n - 1 * , 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=[0.8,0.6]T,x2=[0.1,0.1,0.1,0.1]T,x3=[5,5,5,3,3,3]T
计算初始化设计变量下机械臂各性能为:
J1=—1.2,J2=1.3879,J3=1.6411,J4=0.4393。
结合机械臂初始性能,给定各性能最终优化的次最优指标:
J 1 * = - 1.3 , J 2 * = 0.7 , J 3 * = 1.5 , J 4 * = 0.35 .
经过24次叠代,各性能都达到各性能可接受的性能值。在迭代过程中,广义性能指标Z1、Z2、Z3、Z4的值随迭代次数变化的变化图分别由图4、图5、图6、图7所示。
x1=[0.854,0.673]T,x2=[0.086,0.086,0.081,0.107]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所示。
 
设计变量 初始设计值 最终设计值
臂2长度 0.8 0.845
臂3长度 0.6 0.673
臂2外截面高 0.1 0.086
臂2外截面宽 0.1 0.086
臂3外截面高 0.1 0.081
臂3外截面宽 0.1 0.107
关节1最大角加速度 5 8.26
关节2最大角加速度 5 7.87
关节3最大角加速度 5 8.48
关节1最大角速度 3 4.99
关节2最大角速度 3 4.84
关节3最大角速度 3 4.28
表1  实施例2中设计变量初始值及最终设计值
 
性能指标Ji 初始性能值 性能参考值 最终性能值
J1 -1.2 -1.3 -1.346
J2 1.3879 0.7 0.642
J3 1.6411 1.5 1.4736
J4 0.4393 0.35 0.3494
表2  实施例2中可接受性能值及性能变化

Claims (1)

1.一种三自由度搬运工业机器人多目标优化设计参数的获取方法,所述的三自由度搬运工业机器人包括:第一机械臂(1)、第二机械臂(2)及第三机械臂(3),第二机械臂(2)的两端分别与第一机械臂(1)的一端、第三机械臂(3)的一端转动连接,其特征在于多目标优化设计参数的获取方法含有以下步骤:
步骤1 建立机械臂运动学模型、强度分析模型、基于机电耦合系统动力学模型及逆动力学控制的系统闭环模型,并使用机械臂运动学模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的工作空间性能指标:
J1=λ1Rmin2Rmax=f1(l2,l3),
其中,Rmin为工作空间最小半径,Rmax为工作空间最大半径,λ1、λ2分别为最小半径与最大半径的权系数,l2为第二机械臂的臂长,l3为第三机械臂的臂长;
使用强度分析模型获得涉及第二机械臂(2)及第三机械臂(3)的综合强度性能指标:
J 2 = ( | &sigma; 2 max - 0.8 [ &sigma; ] | + | &sigma; 3 max - 0.8 [ &sigma; ] | ) / ( 7 &times; 10 7 )
   = f 2 ( l 2 , b 2 , h 2 , b 2 e , h 2 e , l 3 , b 3 , h 3 , b 3 e , h 3 e , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max , &theta; . 3 max ) ,
其中,[σ]为第二机械臂(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)内腔的宽度及高度,
Figure A200910030062C0002163403QIETU
Figure A200910030062C0002163405QIETU
分别为第二关节、第三关节的最大角加速度,
Figure A200910030062C0002163419QIETU
Figure A200910030062C0002163422QIETU
Figure A200910030062C0002163424QIETU
分别为第一关节、第二关节、第三关节的最大角速度,7×107为比例系数;
使用系统闭环模型获得第一机械臂(1)、第二机械臂(2)及第三机械臂(3)的平均控制能量指标:
J 3 = 1 200 &Sigma; n = 1 200 1 m Ln ( | &theta; 1 n | + | &theta; 2 n | + | &theta; 3 n | ) [ &Integral; 0 t fn | &tau; 1 ( t ) | dt + &Integral; 0 t fn | &tau; 2 ( t ) | dt + &Integral; 0 t fn | &tau; 3 ( t ) | dt ] ,
   = f 3 ( l 1 , R 1 , r 1 , l 2 , b 2 , h 2 , b 2 e , h 2 e , l 3 , b 3 , h 3 , b 3 e , h 3 e , &theta; . . 1 max , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max , &theta; . 3 max )
及平均控制时间指标
J 4 = 1 200 &Sigma; n = 1 200 t fn ( | &theta; 1 n | + | &theta; 2 n | + | &theta; 3 n | ) = f 4 ( l 1 , l 2 , l 3 , &theta; . . 1 max , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max , &theta; . 3 max ) ,
其中,200是指在给定设计要求的工作空间中随机选取400个点作为搬运任务的起止点,由此组成200组搬运任务工作点;n表示第n组搬运任务,mLn表示第n组搬运任务的负载质量,|θ1n|、|θ2n|、|θ3n|分别表示表示完成第n组搬运任务第一关节、第二关节及第三关节的转动角度,τ1(t)、τ2(t)、τ3(t)分别表示完成第n组搬运任务第一关节、第二关节及第三关节在t时刻输出的电磁转矩,tfn表示完成第n组搬运任务的完成时间,R1、r1分别为圆筒形的第一机械臂(1)外半径及内半径,
Figure A200910030062C0003092308QIETU
为第一关节的最大角加速度;
步骤2 对工作空间性能指标、综合强度性能指标、平均控制能量指标及平均控制时间指标涉及的参数进行选择性优化,并建立多目标并行优化模型首先,选择参数l2、l3、b2、h2、b3、h3
Figure A200910030062C0003163246QIETU
Figure A200910030062C0003163249QIETU
Figure A200910030062C0003163252QIETU
Figure A200910030062C0003163258QIETU
作为设计变量,对
工作空间性能指标
J1=λ1Rmin2Rmax
综合强度性能指标
J2=|σ2Zmax-0.8[σ]|+|σ3zmax-0.8[σ]|,
平均控制能量指标
J 3 = 1 200 &Sigma; n = 1 200 1 m Ln ( | &theta; 1 n | + | &theta; 2 n | + | &theta; 3 n | ) [ &Integral; 0 t fn | &tau; 1 ( t ) | dt + &Integral; 0 t fn | &tau; 2 ( t ) | dt + &Integral; 0 t fn | &tau; 3 ( t ) | dt ] ,
及平均控制时间指标
J 4 = 1 200 &Sigma; n = 1 200 t fn ( | &theta; 1 n | + | &theta; 2 n | + | &theta; 3 n | )
进行同时优化,得到多目标优化设计任务:
min J 1 ( x 1 ) min J 2 ( x 2 ; x 1 , x 3 ) min J 3 ( x 3 ; x 1 , x 2 ) min J 4 ( x 3 ; x 1 ) s . t &phi; 1 &le; 0 ; &phi; 2 &le; 0 ; &phi; 3 &le; 0
其中,x1是由设计变量l2、l3组成的向量, x 1 = [ x 1 1 , x 1 2 ] T = [ l 2 , l 3 ] T , 称之为臂长设计向量,其中,
Figure A200910030062C00043
的下标1表示设计向量x1,上标1表示设计向量x1的第一分量,
Figure A200910030062C00044
的下标1表示设计向量x1,上标2表示设计向量x1的第二分量;x2是由设计变量b2、h2、b3、h3组成的向量, x 2 = [ x 2 1 , x 2 2 , x 2 3 , x 2 4 ] T = [ h 2 , b 2 , h 3 , b 3 ] T , 称之为臂的厚度设计向量,其中,
Figure A200910030062C00046
的下标2表示设计向量x2,上标1表示设计向量x2的第一分量,
Figure A200910030062C00047
的下标2表示设计向量x2,上标2表示设计向量x2的第二分量,
Figure A200910030062C00048
的下标2表示设计向量x2,上标3表示设计向量x2的第三分量,的下标2表示设计向量x2,上标4表示设计向量x2的第四分量;x3是由设计变量
Figure A200910030062C0004163605QIETU
Figure A200910030062C0004163610QIETU
Figure A200910030062C0004163625QIETU
Figure A200910030062C0004163629QIETU
Figure A200910030062C0004163634QIETU
组成的向量, x 3 = [ x 3 1 , x 3 2 , x 3 3 , x 3 4 , x 3 5 , x 3 6 ] T = [ &theta; . . 1 max , &theta; . . 2 max , &theta; . . 3 max , &theta; . 1 max , &theta; . 2 max , &theta; . 3 max ] T , 称之为关节的运动学能力设计向量,
Figure A200910030062C000412
的下标3表示设计向量x3,上标1表示设计向量x3的第一分量,
Figure A200910030062C000413
的下标3表示设计向量x3,上标2表示设计向量x3的第二分量,
Figure A200910030062C000414
的下标3表示设计向量x3,上标3表示设计向量x3的第三分量,
Figure A200910030062C000415
的下标3表示设计向量x3,上标4表示设计向量x3的第四分量,
Figure A200910030062C000416
的下标3表示设计向量x3,上标5表示设计向量x3的第五分量,
Figure A200910030062C000417
的下标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为第三约束条件向量 &phi; 3 = [ - &theta; . . 1 max , - &theta; . . 2 max , - &theta; . . 3 max , - &theta; . 1 max , - &theta; . 2 max , - &theta; . 3 max ] T ;
其次,将约束条件与工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4进行合并转化,得到广义工作空间性能指标Z1,广义综合强度性能指标Z2,广义平均控制能量指标Z3及广义平均控制时间指标Z4
Z 1 = max { 0 , J 1 - J 1 * } + &sigma; 1 &Sigma; m = 1 5 max { 0 , &phi; 1 m } 2 Z 2 = max { 0 , J 2 - J 2 * } + &sigma; 2 &Sigma; m = 1 4 max { 0 , &phi; 2 m } 2 Z 3 = max { 0 , J 3 - J 3 * } + &sigma; 3 &Sigma; m = 1 6 max { 0 , &phi; 3 m } 2 Z 4 = max { 0 , J 4 - J 4 * }
其中,
Figure A200910030062C00052
分别是工作空间性能指标J1、综合强度性能指标J2、平均控制能量指标J3及平均控制时间指标J4的期望值,分别表示第一约束条件向量的第m个元素、第二约束条件向量的第m个元素、第三约束条件向量的第m个元素;σ1为第一罚系数,σ1=1000;σ2为第二罚系数,σ2=1000;σ3为第三罚系数,σ3=1000;
步骤3 用控制方法获得多目标优化设计参数
建立第一控制律: v 1 , i = k 1 1 e 1 , i - 1 o 1 , i - 1 1 + k 1 2 e 2 , i - 1 o 1 , i - 1 2 + k 1 3 e 3 , i - 1 o 1 , i - 1 3 + k 1 4 e 4 , i - 1 o 1 , i - 1 4
其中,v1,i为第i次迭代时臂长设计向量x1的调整量, v 1 , i = [ v 1 , i 1 , v 1 , i 2 ] T ,
Figure A200910030062C00056
的第一下标1和上标1表示该调整量是对设计向量x1中的第一设计变量
Figure A200910030062C0005092732QIETU
的调整量,第二下标i表示迭代次数,
Figure A200910030062C00057
的第一下标1和上标2表示该调整量是对设计向量x1中的第二设计变量
Figure A200910030062C00058
的调整量,第二下标i表示迭代次数;
对第一控制律产生的调整量v1,i的调整幅度进行修正:
如果 0 < | v 1 , i 1 | &le; 0.01 | x 1 , i - 1 1 | , v 1 , i 1 = sign ( x 1 , i - 1 1 ) &times; 0.01 | x 1 , i - 1 1 | ,
     0 < | v 1 , i 2 | &le; 0.01 | x 1 , i - 1 2 | , v 1 , i 2 = sign ( x 1 , i - 1 2 ) &times; 0.01 | x 1 , i - 1 2 | ,
如果 | v 1 , i 1 | &GreaterEqual; 0.04 | x 1 , i - 1 1 | , v 1 , i 1 = sign ( x 1 , i - 1 1 ) &times; 0.04 | x 1 , i - 1 1 | ,
     | v 1 , i 2 | &GreaterEqual; 0.04 | x 1 , i - 1 2 | , v 1 , i 2 = sign ( x 1 , i - 1 2 ) &times; 0.04 | x 1 , i - 1 2 | ;
其中,
Figure A200910030062C000517
表示设计向量x1的第一设计分量
Figure A200910030062C000518
第i—1次迭代后的设计值,
Figure A200910030062C000519
表示设计向量x1的第二设计分量
Figure A200910030062C000520
第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
Figure A200910030062C00061
为误差值e1,i-1相对于设计向量值x1,i-1的负导数对应的符号向量, o 1 , i - 1 2 = sign { - de 1 , i - 1 dx 1 , i - 1 } , 的上标1表示广义工作空间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062C0006095140QIETU
时广义工作空间性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062C00064
为误差值e2,i-1相对于设计向量值x1,i-1的负导数对应的符号向量, o 1 , i - 1 2 = sign { - &PartialD; e 2 , i - 1 &PartialD; x 1 , i - 1 } ,
Figure A200910030062C00066
的上标2表示广义综合强度性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算时广义综合强度性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062C00068
为误差值e3,i-1相对于设计向量值x1,i-1的偏导数的符号向量, o 1 , i - 1 3 = sign { - &PartialD; e 3 , i - 1 &PartialD; x 1 , i - 1 } ,
Figure A200910030062C000610
的上标3表示广义平均控制能量指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062C000611
时广义平均控制能量性能指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062C000612
为误差值e4,i-1相对于设计向量值x1,i-1的偏导数的符号向量, o 1 , i - 1 4 = sign { - &PartialD; e 4 , i - 1 &PartialD; x 1 , i - 1 } ,
Figure A200910030062C000614
的上标4表示广义平均控制时间性能指标的误差,第一下标1表示臂长设计向量,第二下标i—1表示在计算
Figure A200910030062C000615
时广义平均控制时间指标的误差值及臂长设计向量的值为第i—1次迭代后的值;
Figure A200910030062C000616
为误差值e1,i-1在控制律1中的比例系数,
Figure A200910030062C000617
上标1表示广义工作空间性能指标的误差,下标1表示控制律1,并且令 k 1 1 = 1 ;
Figure A200910030062C00072
为误差值e2,i-1在控制律1中的比例系数,
Figure A200910030062C00073
上标2表示广义综合强度性能指标的误差,下标1表示控制律1,并且令 k 1 2 = 1 &times; 10 - 2 ;
Figure A200910030062C00075
为误差值e3,i-1在控制律1中的比例系数,上标3表示广义平均控制能量性能指标的误差,下标1表示控制律1,并且令 k 1 3 = 5 &times; 10 - 4 ;
Figure A200910030062C00078
为误差值e4,i-1在控制律1中的比例系数,
Figure A200910030062C00079
上标4表示广义平均控制时间性能指标的误差,下标1表示控制律1,并且令 k 1 4 = 1 &times; 10 - 4 ;
建立第二控制律: v 2 , i = k 2 2 e 2 , i - 1 o 2 , i - 1 2 + k 2 3 e 3 , i - 1 o 2 , i - 1 3
其中,v2,i为第i次迭代时臂厚设计向量x2的调整量, v 2 , i = [ v 2 , i 1 , v 2 , i 2 , v 2 , i 3 , v 2 , i 4 ] T ,
Figure A200910030062C000713
的第一下标2和上标1表示该调整量是对设计向量x2中的第一设计分量
Figure A200910030062C000714
的调整量,第二下标i表示迭代次数,
Figure A200910030062C000715
的第一下标2和上标2表示该调整量是对设计向量x2中的第二设计分量
Figure A200910030062C000716
的调整量,第二下标i表示迭代次数,的第一下标2和上标3表示该调整量是对设计向量x2中的第三设计分量
Figure A200910030062C000718
的调整量,第二下标i表示迭代次数,
Figure A200910030062C000719
的第一下标2和上标4表示该调整量是对设计向量x2中的第四设计分量的调整量,第二下标i表示迭代次数;
对第二控制律产生的调整量v2,i的调整幅度进行修正:
如果 0 < | v 2 , i 1 | &le; 0.01 | x 2 , i - 1 1 | , v 2 , i 1 = sign ( x 2 , i - 1 1 ) &times; 0.01 | x 2 , i - 1 1 | ,
     0 < | v 2 , i 2 | &le; 0.01 | x 2 , i - 1 2 | , v 2 , i 2 = sign ( x 2 , i - 1 2 ) &times; 0.01 | x 2 , i - 1 2 | ,
     0 < | v 2 , i 3 | &le; 0.01 | x 2 , i - 1 3 | , v 2 , i 3 = sign ( x 2 , i - 1 3 ) &times; 0.01 | x 2 , i - 1 3 | ,
     0 < | v 2 , i 4 | &le; 0.01 | x 2 , i - 1 4 | , v 2 , i 4 = sign ( x 2 , i - 1 4 ) &times; 0.01 | x 2 , i - 1 4 | ;
如果 | v 2 , i 1 | &GreaterEqual; 0.02 | x 2 , i - 1 1 | , v 2 , i 1 = sign ( x 2 , i - 1 1 ) &times; 0.02 | x 2 , i - 1 1 | ,
     | v 2 , i 2 | &GreaterEqual; 0.02 | x 2 , i - 1 2 | , v 2 , i 2 = sign ( x 2 , i - 1 2 ) &times; 0.02 | x 2 , i - 1 2 | ,
     | v 2 , i 3 | &GreaterEqual; 0.02 | x 2 , i - 1 3 | , v 2 , i 3 = sign ( x 2 , i - 1 3 ) &times; 0.02 | x 2 , i - 1 3 | ,
     | v 2 , i 4 | &GreaterEqual; 0.02 | x 2 , i - 1 4 | , v 2 , i 4 = sign ( x 2 , i - 1 4 ) &times; 0.02 | x 2 , i - 1 4 | ;
其中,表示设计向量x2的第一设计分量第i—1次迭代后的设计值,
Figure A200910030062C000739
表示设计向量x2的第二设计分量
Figure A200910030062C00081
第i—1次迭代后的设计值,
Figure A200910030062C00082
表示设计向量x2的第三设计分量第i—1次迭代后的设计值,
Figure A200910030062C00084
表示设计向量x2的第四设计分量
Figure A200910030062C00085
第i—1次迭代后的设计值;
用修正后的调整值v2,i调整臂厚设计向量,得到第i次迭代后设计向量x2的值x2,i=x2,i-1+v2,i
Figure A200910030062C00086
为误差值e2,i-1相对于设计向量值x2,i-1的负导数对应的符号向量, o 2 , i - 1 2 = sign { - &PartialD; e 2 , i - 1 &PartialD; x 2 , i - 1 } , 的上标2表示广义综合强度性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算
Figure A200910030062C00089
时广义综合强度性能指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
Figure A200910030062C000810
为误差值e3,i-1相对于设计向量值x2,i-1的偏导数的符号向量, o 2 , i - 1 3 = sign { - &PartialD; e 3 , i - 1 &PartialD; x 2 , i - 1 } ,
Figure A200910030062C000812
的上标3表示广义平均控制能量性能指标的误差,第一下标2表示臂厚设计向量,第二下标i—1表示在计算时广义平均控制能量指标的误差值及臂厚设计向量的值为第i—1次迭代后的值;
Figure A200910030062C000814
为误差e2,i-1在控制律2中的比例系数,
Figure A200910030062C000815
上标2表示广义综合强度性能指标的误差,下标2表示控制律2,并且令 k 2 2 = 1 ;
Figure A200910030062C000817
为误差e3,i-1在控制律2中的比例系数,
Figure A200910030062C000818
上标3表示广义平均控制能量性能指标的误差,下标2表示控制律1,并且令 k 2 3 = 1 &times; 10 - 2 ;
建立第三控制律: v 3 , i = k 3 2 e 2 , i - 1 o 3 , i - 1 2 + k 3 3 e 3 , i - 1 o 3 , i - 1 3 + k 3 4 e 4 , i - 1 o 3 , i - 1 4
其中,v3,i为第i次迭代时关节运动学能力设计向量x3的调整量, v 3 , i = [ v 3 , i 1 , v 3 , i 2 , v 3 , i 3 , v 3 , i 4 , v 3 , i 5 , v 3 , i 6 ] T , 的第一下标3和上标1表示该调整量是对设计向量x3中的第一设计分量
Figure A200910030062C000823
的调整量,第二下标i表示迭代次数,
Figure A200910030062C000824
的第一下标3和上标2表示该调整量是对设计向量x3中的第二个设计分量
Figure A200910030062C000825
的调整量,第二下标i表示迭代次数,的第一下标3和上标3表示该调整量是对设计向量x3中的第三设计分量
Figure A200910030062C000827
的调整量,第二下标i表示迭代次数,
Figure A200910030062C000828
的第一下标3和上标4表示该调整量是对设计向量x3中的第四设计分量
Figure A200910030062C000829
的调整量,第二下标i表示迭代次数;
Figure A200910030062C00091
的第一下标3和上标5表示该调整量是对设计向量x3中的第五设计分量
Figure A200910030062C00092
的调整量,第二下标i表示迭代次数;
Figure A200910030062C00093
的第一下标3和上标6表示该调整量是对设计向量x3中的第六设计分量
Figure A200910030062C00094
的调整量,第二下标i表示迭代次数;
对第三控制律产生的调整量v3,i的调整幅度进行修正:
如果 0 < | v 3 , i 1 | &le; 0.01 | x 3 , i - 1 1 | , v 3 , i 1 = sign ( x 3 , i - 1 1 ) &times; 0.01 | x 3 , i - 1 1 | ,
     0 < | v 3 , i 2 | &le; 0.01 | x 3 , i - 1 2 | , v 3 , i 2 = sign ( x 3 , i - 1 2 ) &times; 0.01 | x 3 , i - 1 2 | ,
     0 < | v 3 , i 3 | &le; 0.01 | x 3 , i - 1 3 | , v 3 , i 3 = sign ( x 3 , i - 1 3 ) &times; 0.01 | x 3 , i - 1 3 | ,
     0 < | v 3 , i 4 | &le; 0.01 | x 3 , i - 1 4 | , v 3 , i 4 = sign ( x 3 , i - 1 4 ) &times; 0.01 | x 3 , i - 1 4 | ,
     0 < | v 3 , i 5 | &le; 0.01 | x 3 , i - 1 5 | , v 3 , i 5 = sign ( x 3 , i - 1 5 ) &times; 0.01 | x 3 , i - 1 5 | ,
     0 < | v 3 , i 6 | &le; 0.01 | x 3 , i - 1 6 | , v 3 , i 6 = sign ( x 3 , i - 1 6 ) &times; 0.01 | x 3 , i - 1 6 | ;
如果 | v 3 , i 1 | &GreaterEqual; 0.1 | x 3 , i - 1 1 | , v 3 , i 1 = sign ( x 3 , i - 1 1 ) &times; 0.1 | x 3 , i - 1 1 | ,
     | v 3 , i 2 | &GreaterEqual; 0.1 | x 3 , i - 1 2 | , v 3 , i 2 = sign ( x 3 , i - 1 2 ) &times; 0.1 | x 3 , i - 1 2 | ,
     | v 3 , i 3 | &GreaterEqual; 0.1 | x 3 , i - 1 3 | , v 3 , i 3 = sign ( x 3 , i - 1 3 ) &times; 0.1 | x 3 , i - 1 3 | ,
     | v 3 , i 4 | &GreaterEqual; 0.1 | x 3 , i - 1 4 | , v 3 , i 4 = sign ( x 3 , i - 1 4 ) &times; 0.1 | x 3 , i - 1 4 | ,
     | v 3 , i 5 | &GreaterEqual; 0.1 | x 3 , i - 1 5 | , v 3 , i 5 = sign ( x 3 , i - 1 5 ) &times; 0.1 | x 3 , i - 1 5 | ,
     | v 3 , i 6 | &GreaterEqual; 0.1 | x 3 , i - 1 6 | , v 3 , i 6 = sign ( x 3 , i - 1 6 ) &times; 0.1 | x 3 , i - 1 6 | ;
其中,
Figure A200910030062C000929
表示设计向量x3的第一设计分量
Figure A200910030062C000930
第i—1次迭代后的设计值,表示设计向量x3的第二设计分量
Figure A200910030062C000932
第i—1次迭代后的设计值,
Figure A200910030062C000933
表示设计向量x3的第三设计分量
Figure A200910030062C000934
第i—1次迭代后的设计值,
Figure A200910030062C000935
表示设计向量x3的第四设计分量
Figure A200910030062C000936
第i—1次迭代后的设计值,
Figure A200910030062C000937
表示设计向量x3的第五设计分量
Figure A200910030062C000938
第i—1次迭代后的设计值,
Figure A200910030062C000939
表示设计向量x3的第六设计分量
Figure A200910030062C000940
第i—1次迭代后的设计值;
用修正后的调整量v3,i调整关节的运动学能力设计向量x3,计算第i次迭代后设计向量x3的值x3,i=x3,i-1+v3,i
Figure A200910030062C00101
为误差值e2,i-1相对于设计向量值x3,i-1的负导数对应的符号向量, o 3 , i - 1 2 = sign { - &PartialD; e 2 , i - 1 &PartialD; x 3 , i - 1 } ,
Figure A200910030062C00103
的上标2表示广义综合强度性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
Figure A200910030062C00104
时广义综合强度性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
Figure A200910030062C00105
为误差值e3,i-1相对于设计向量值x3,i-1的偏导数的符号向量, o 3 , i - 1 3 = sign { - &PartialD; e 3 , i - 1 &PartialD; x 3 , i - 1 } ,
Figure A200910030062C00107
的上标3表示广义平均控制能量性能指标的误差,第一下标3表示运动学能力设计向量,第二下标i—1表示在计算
Figure A200910030062C00108
时广义平均控制能量性能指标的误差值及运动学能力向量的值为第i—1次迭代后的值;
Figure A200910030062C00109
为误差值e4,i-1相对于设计向量值x3,i-1的偏导数的符号向量, o 3 , i - 1 4 = sign { - &PartialD; e 4 , i - 1 &PartialD; x 3 , i - 1 } ,
Figure A200910030062C001011
的上标4表示广义平均控制时间性能指标的误差,第一下标3表示设计向量,第二下标i—1表示在计算
Figure A200910030062C001012
时广义平均控制时间性能指标的误差值及运动学能力设计向量的值为第i—1次迭代后的值;
Figure A200910030062C001013
为误差值e2,i-1在控制律3中的比例系数,
Figure A200910030062C001014
上标2表示广义综合强度性能指标的误差,下标3表示控制律3,并且令 k 3 2 = 1 &times; 10 - 2 ;
Figure A200910030062C001016
为误差值e3,i-1在控制律3中的比例系数,
Figure A200910030062C001017
上标3表示广义平均控制能量性能指标的误差,下标3表示控制律3,并且令 k 3 3 = 0.5 ;
Figure A200910030062C001019
为误差值e4,i-1在控制律4中的比例系数,
Figure A200910030062C001020
上标4表示广义平均控制时间性能指标的误差,下标4表示控制律4,并且令 k 3 4 = 1 ;
利用第一控制律、第二控制律、第三控制律对臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3进行第一次优化设计:
为臂长设计向量x1、臂厚设计向量x2、关节运动学能力设计向量x3赋初始设计值,得到向量x1,0、向量x2,0、向量x3,0
为各性能指标期望值
Figure A200910030062C001022
赋第一次多目标优化设计的参考值
Figure A200910030062C001023
得到 J 1 , 1 * = - 1.3 , J 2,1 * = 0.7 , J 3,1 * = 1.5 , J 4,1 * = 0.35 , 对于
Figure A200910030062C001029
其第一下标1表示工作空间性能表,第二下标1表示第一次多目标优化设计,对于
Figure A200910030062C00111
其第一下标2表示综合强度性能指标,第二下标1表示第一次多目标优化设计,对于
Figure A200910030062C00112
,其第一下标3表示平均控制能量指标,第二下标1表示第一次多目标优化设计,对于,其第一下标4表示平均控制时间指标,第二下标1表示第一次多目标优化设计;
由第一次多目标优化设计的参考值
Figure A200910030062C00114
及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:
首先,由第一控制律 v 1 , 1 = k 1 1 e 1 , 0 o 1 , 0 1 + k 1 2 e 2 , 0 o 1 , 0 2 + k 1 3 e 3 , 0 o 1 , 0 3 + k 1 4 e 4 , 0 o 1 , 0 4 及对第一控制律产生的调整量v1,1幅度修正方法:
如果 0 < | v 1 , 1 1 | &le; 0.01 | x 1 , 0 1 | , v 1 , 1 1 = sign ( x 1 , 0 1 ) &times; 0.01 | x 1 , 0 1 | ,
     0 < | v 1 , 1 2 | &le; 0.01 | x 1 , 0 2 | , v 1 , 1 2 = sign ( x 1 , 0 2 ) &times; 0.01 | x 1 , 0 2 | ,
如果 | v 1 , 1 1 | &GreaterEqual; 0.04 | x 1 , 0 1 | , v 1 , 1 1 = sign ( x 1 , 0 1 ) &times; 0.04 | x 1 , 0 1 | ,
     | v 1 , 1 2 | &GreaterEqual; 0.04 | x 1 , 0 2 | , v 1 , 1 2 = sign ( x 1 , 0 2 ) &times; 0.04 | x 1 , 0 2 | ;
生成对向量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的负导数对应的符号向量, o 1 , 0 1 = sign { - de 1 , 0 dx 1 , 0 } , 为误差值e2,0相对于设计向量值x1,0的负偏导数对应的符号向量, o 1 , 0 2 = sign { - &PartialD; e 2 , 0 &PartialD; x 1 , 0 } ;
Figure A200910030062C001118
为误差值e3,0相对于设计向量值x1,0的负偏导数对应的符号向量, o 1 , 0 3 = sign { - &PartialD; e 3 , 0 &PartialD; x 1 , 0 } ;
Figure A200910030062C00122
为误差值e4,0相对于设计向量值x1,0的负偏导数对应的符号向量, o 1 , 0 4 = sign { - &PartialD; e 4 , 0 &PartialD; x 1 , 0 } ;
其次,由第二控制律 v 2,1 = k 2 2 e 2,0 o 2,0 2 + k 2 3 e 3,0 o 2,0 3 及对第二控制律产生的调整量v2,1的幅度修正方法:
如果 0 < | v 2 , 1 1 | &le; 0.01 | x 2 , 0 1 | , v 2 , 1 1 = sign ( x 2 , 0 1 ) &times; 0.01 | x 2 , 0 1 | ,
     0 < | v 2 , 1 2 | &le; 0.01 | x 2 , 0 2 | , v 2 , 1 2 = sign ( x 2 , 0 2 ) &times; 0.01 | x 2 , 0 2 | ,
     0 < | v 2 , 1 3 | &le; 0.01 | x 2 , 0 3 | , v 2 , 1 3 = sign ( x 2 , 0 3 ) &times; 0.01 | x 2 , 0 3 | ,
     0 < | v 2 , 1 4 | &le; 0.01 | x 2 , 0 4 | , v 2 , 1 4 = sign ( x 2 , 0 4 ) &times; 0.01 | x 2 , 0 4 | ;
如果 | v 2 , 1 1 | &GreaterEqual; 0.02 | x 2 , 0 1 | , v 2 , 1 1 = sign ( x 2 , 0 1 ) &times; 0.02 | x 2 , 0 1 | ,
     | v 2 , 1 2 | &GreaterEqual; 0.02 | x 2 , 0 2 | , v 2 , 1 2 = sign ( x 2 , 0 2 ) &times; 0.02 | x 2 , 0 2 | ,
     | v 2 , 1 3 | &GreaterEqual; 0.02 | x 2 , 0 3 | , v 2 , 1 3 = sign ( x 2 , 0 3 ) &times; 0.02 | x 2 , 0 3 | ,
     | v 2 , 1 4 | &GreaterEqual; 0.02 | x 2 , 0 4 | , v 2 , 1 4 = sign ( x 2 , 0 4 ) &times; 0.02 | x 2 , 0 4 | ;
生成对臂厚设计向量x2的第一次迭代的调整值v2,1’用调整值v2,1调整臂厚设计向量x2,得到向量x2的第一次迭代后的值x2,1=x2,0+v2,1;这里,
Figure A200910030062C001221
为误差值e2,0相对于设计向量值x2,0的负偏导数对应的符号向量, o 2 , 0 2 = sign { - &PartialD; e 2 , 0 &PartialD; x 2 , 0 } ; 为误差值e3,0相对于设计向量值x2,0的负偏导数对应的符号向量, o 2 , 0 3 = sign { - &PartialD; e 3 , 0 &PartialD; x 2 , 0 } ;
再次,由第三控制律 v 3,1 = k 3 2 e 2,0 o 3,0 2 + k 3 3 e 3,0 o 3,0 3 + k 3 4 e 4,0 o 3,0 4 及对第三控制律产生的调整量v3,1的幅度修正方法:
如果 0 < | v 3 , 1 1 | &le; 0.01 | x 3 , 0 1 | , v 3 , 1 1 = sign ( x 3 , 0 1 ) &times; 0.01 | x 3 , 0 1 | ,
     0 < | v 3 , 1 2 | &le; 0.01 | x 3 , 0 2 | , v 3 , 1 2 = sign ( x 3 , 0 2 ) &times; 0.01 | x 3 , 0 2 | ,
     0 < | v 3 , 1 3 | &le; 0.01 | x 3 , 0 3 | , v 3 , 1 3 = sign ( x 3 , 0 3 ) &times; 0.01 | x 3 , 0 3 | ,
     0 < | v 3 , 1 4 | &le; 0.01 | x 3 , 0 4 | , v 3 , 1 4 = sign ( x 3 , 0 4 ) &times; 0.01 | x 3 , 0 4 | ,
     0 < | v 3 , 1 5 | &le; 0.01 | x 3 , 0 5 | , v 3 , 1 5 = sign ( x 3 , 0 5 ) &times; 0.01 | x 3 , 0 5 | ,
     0 < | v 3 , 1 6 | &le; 0.01 | x 3 , 0 6 | , v 3 , 1 6 = sign ( x 3 , 0 6 ) &times; 0.01 | x 3 , 0 6 | ;
如果 | v 3 , 1 1 | &GreaterEqual; 0.1 | x 3 , 0 1 | , v 3 , 1 1 = sign ( x 3 , 0 1 ) &times; 0.1 | x 3 , 0 1 | ,
     | v 3 , 1 2 | &GreaterEqual; 0.1 | x 3 , 0 2 | , v 3 , 1 2 = sign ( x 3 , 0 2 ) &times; 0.1 | x 3 , 0 2 | ,
     | v 3 , 1 3 | &GreaterEqual; 0.1 | x 3 , 0 3 | , v 3 , 1 3 = sign ( x 3 , 0 3 ) &times; 0.1 | x 3 , 0 3 | ,
     | v 3 , 1 4 | &GreaterEqual; 0.1 | x 3 , 0 4 | , v 3 , 1 4 = sign ( x 3 , 0 4 ) &times; 0.1 | x 3 , 0 4 | ,
     | v 3 , 1 5 | &GreaterEqual; 0.1 | x 3 , 0 5 | , v 3 , 1 5 = sign ( x 3 , 0 5 ) &times; 0.1 | x 3 , 0 5 | ,
     | v 3 , 1 6 | &GreaterEqual; 0.1 | x 3 , 0 6 | , v 3 , 1 6 = sign ( x 3 , 0 6 ) &times; 0.1 | x 3 , 0 6 | ;
生成对关节运动学能力设计向量x3的第一次调整值v3,1’用调整值v3,1调整关节运动学能力设计向量x3,得到设计向量x3的第一次迭代后的值x3,1=x3,0+v3,1;这里,
Figure A200910030062C001319
为误差值e2,0相对于x3,0的负偏导数对应的符号向量, o 3 , 0 2 = sign { - &PartialD; e 2 , 0 &PartialD; x 3 , 0 } ; 为误差值e3,0相对于设计向量值x3,0的负偏导数对应的符号向量, o 3 , 0 3 = sign { - &PartialD; e 3 , 0 &PartialD; x 3 , 0 } ;
Figure A200910030062C001323
为误差值e4,0相对于设计向量值x3,0的负偏导数对应的符号向量, o 3 , 0 4 = sign { - &PartialD; e 4 , 0 &PartialD; x 3 , 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:首先,由第一控制律 v 1,2 = k 1 1 e 1,1 o 1,1 1 + k 1 2 e 2,1 o 1,1 2 + k 1 3 e 3,1 o 1,1 3 + k 1 4 e 4,1 o 1,1 4 及对第一控制律产生的调整量v1,2幅度修正方法:
如果 0 < | v 1 , 2 1 | &le; 0.01 | x 1 , 1 1 | , v 1 , 2 1 = sign ( x 1 , 1 1 ) &times; 0.01 | x 1 , 1 1 | ,
     0 < | v 1 , 2 2 | &le; 0.01 | x 1 , 1 2 | , v 1 , 2 2 = sign ( x 1 , 1 2 ) &times; 0.01 | x 1 , 1 2 | ,
如果 | v 1 , 2 1 | &GreaterEqual; 0.04 | x 1 , 1 1 | , v 1 , 2 1 = sign ( x 1 , 1 1 ) &times; 0.04 | x 1 , 1 1 | ,
     | v 1 , 2 2 | &GreaterEqual; 0.04 | x 1 , 1 2 | , v 1 , 2 2 = sign ( x 1 , 1 2 ) &times; 0.04 | x 1 , 1 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的负导数对应的符号向量, o 1 , 1 1 = sign { - de 1 , 1 dx 1 , 1 } ;
Figure A200910030062C00149
为误差值e2,1相对于设计向量值x1,1的负偏导数对应的符号向量, o 1 , 1 2 = sign { - &PartialD; e 2 , 1 &PartialD; x 1 , 1 } ;
Figure A200910030062C001411
为误差值e3,1相对于设计向量值x1,1的负偏导数对应的符号向量, o 1 , 1 3 = sign { - &PartialD; e 3 , 1 &PartialD; x 1 , 1 } ;
Figure A200910030062C001413
为误差值e4,1相对于设计向量值x1,1的负偏导数对应的符号向量, o 1 , 1 4 = sign { - &PartialD; e 4 , 1 &PartialD; x 1 , 1 } ;
其次,由第二控制律 v 2,2 = k 2 2 e 2,1 o 2,1 2 + k 2 3 e 3,1 o 2,1 3 及对第二控制律产生的调整量v2,2的幅度修正方法:
如果 0 < | v 2 , 2 1 | &le; 0.01 | x 2 , 1 1 | , v 2 , 2 1 = sign ( x 2 , 1 1 ) &times; 0.01 | x 2 , 1 1 | ,
     0 < | v 2 , 2 2 | &le; 0.01 | x 2 , 1 2 | , v 2 , 2 2 = sign ( x 2 , 1 2 ) &times; 0.01 | x 2 , 1 2 | ,
     0 < | v 2 , 2 3 | &le; 0.01 | x 2 , 1 3 | , v 2 , 2 3 = sign ( x 2 , 1 3 ) &times; 0.01 | x 2 , 1 3 | ,
     0 < | v 2 , 2 4 | &le; 0.01 | x 2 , 1 4 | , v 2 , 2 4 = sign ( x 2 , 1 4 ) &times; 0.01 | x 2 , 1 4 | ,
如果 | v 2 , 2 1 | &GreaterEqual; 0.02 | x 2 , 1 1 | , v 2 , 2 1 = sign ( x 2 , 1 1 ) &times; 0.02 | x 2 , 1 1 | ,
     | v 2 , 2 2 | &GreaterEqual; 0.02 | x 2 , 1 2 | , v 2 , 2 2 = sign ( x 2 , 1 2 ) &times; 0.02 | x 2 , 1 2 | ,
     | v 2 , 2 3 | &GreaterEqual; 0.02 | x 2 , 1 3 | , v 2 , 2 3 = sign ( x 2 , 1 3 ) &times; 0.02 | x 2 , 1 3 | ,
     | v 2,2 4 | &GreaterEqual; 0.02 | x 2,1 4 | , v 2,2 4 = sign ( x 2,1 4 ) &times; 0.02 | x 2,1 4 | ;
生成设计向量x2进行第二次迭代的调整值 v 2,2 = k 2 2 e 2,1 o 2,1 2 + k 2 3 e 3,1 o 2,1 3 , 再用调整值v2,2调整设计向量x2的值,得到第二次迭代后设计向量x2的值x2,2=x2,1+v2,2;这里,
Figure A200910030062C00153
为误差值e2,1相对于设计向量值x2,1的负偏导数对应的符号向量, o 3 , 1 2 = sign { - &PartialD; e 2 , 1 &PartialD; x 2 , 1 } ;
Figure A200910030062C0015093328QIETU
为误差值e3,1相对于设计向量值x2,1的负偏导数对应的符号向量, o 3 , 1 3 = sign { - &PartialD; e 3 , 1 &PartialD; x 2 , 1 } ;
再次,由第三控制律 v 3,2 = k 3 2 e 2,1 o 3,1 2 + k 3 3 e 3,1 o 3,1 3 + k 3 4 e 4,1 o 3,1 4 及对第三控制律产生的调整量v3,2的幅度修正方法:
如果 0 < | v 3 , 2 1 | &le; 0.01 | x 3 , 1 1 | , v 3 , 2 1 = sign ( x 3 , 1 1 ) &times; 0.01 | x 3 , 1 1 | ,
     0 < | v 3 , 2 2 | &le; 0.01 | x 3 , 1 2 | , v 3 , 2 2 = sign ( x 3 , 1 2 ) &times; 0.01 | x 3 , 1 2 | ,
     0 < | v 3 , 2 3 | &le; 0.01 | x 3 , 1 3 | , v 3 , 2 3 = sign ( x 3 , 1 3 ) &times; 0.01 | x 3 , 1 3 | ,
     0 < | v 3 , 2 4 | &le; 0.01 | x 3 , 1 4 | , v 3 , 2 4 = sign ( x 3 , 1 4 ) &times; 0.01 | x 3 , 1 4 | ,
     0 < | v 3 , 2 5 | &le; 0.01 | x 3 , 1 5 | , v 3 , 2 5 = sign ( x 3 , 1 5 ) &times; 0.01 | x 3 , 1 5 | ,
     0 < | v 3 , 2 6 | &le; 0.01 | x 3 , 1 6 | , v 3 , 2 6 = sign ( x 3 , 1 6 ) &times; 0.01 | x 3 , 1 6 | ;
如果 | v 3 , 2 1 | &GreaterEqual; 0.1 | x 3 , 1 1 | , v 3 , 2 1 = sign ( x 3 , 1 1 ) &times; 0.1 | x 3 , 1 1 | ,
     | v 3 , 1 2 | &GreaterEqual; 0.1 | x 3 , 0 2 | , v 3 , 1 2 = sign ( x 3 , 0 2 ) &times; 0.1 | x 3 , 0 2 | ,
     | v 3 , 2 3 | &GreaterEqual; 0.1 | x 3 , 1 3 | , v 3 , 2 3 = sign ( x 3 , 1 3 ) &times; 0.1 | x 3 , 1 3 | ,
     | v 3 , 2 4 | &GreaterEqual; 0.1 | x 3 , 1 4 | , v 3 , 2 4 = sign ( x 3 , 1 4 ) &times; 0.1 | x 3 , 1 4 | ,
     | v 3 , 2 5 | &GreaterEqual; 0.1 | x 3 , 1 5 | , v 3 , 2 5 = sign ( x 3 , 1 5 ) &times; 0.1 | x 3 , 1 5 | ,
     | v 3 , 2 6 | &GreaterEqual; 0.1 | x 3 , 1 6 | , v 3 , 2 6 = sign ( x 3 , 1 6 ) &times; 0.1 | x 3 , 1 6 | ;
生成设计向量x3的第二次迭代的调整值,再用调整值v3,2调整设计向量x3的值,得到第二次迭代后向量x3的值x3,2=x3,1+v3,2;这里,
Figure A200910030062C001532
为e2,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 3 , 1 2 = sign { - &PartialD; e 2 , 1 &PartialD; x 3 , 1 } ;
Figure A200910030062C001534
为误差值e3,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 3 , 1 3 = sign { - &PartialD; e 3 , 1 &PartialD; x 3 , 1 } ;
Figure A200910030062C00162
为误差值e4,1相对于设计向量值x3,1的负偏导数对应的符号向量, o 3 , 1 4 = sign { - &PartialD; e 4 , 1 &PartialD; x 3 , 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 对各性能指标期望值
Figure A200910030062C00164
的期望值进行第n—1次调整后进行第n次优化设计,令 J 1 , n * = 1.05 &times; J 1 , n - 1 * , J 2 , n * = 1.05 &times; J 2 , n - 1 * , J 3 , n * = 1.05 &times; J 3 , n - 1 * , J 4 , n * = 1.05 &times; J 4 , n - 1 * , n为优化设计的次数,对设计向量x1、x2、x3进行第n次优化设计,重复步骤3.1~步骤3.3。
CN2009100300626A 2009-03-30 2009-03-30 三自由度搬运工业机器人多目标优化设计参数的获取方法 Expired - Fee Related CN101508112B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN2009100300626A CN101508112B (zh) 2009-03-30 2009-03-30 三自由度搬运工业机器人多目标优化设计参数的获取方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN2009100300626A CN101508112B (zh) 2009-03-30 2009-03-30 三自由度搬运工业机器人多目标优化设计参数的获取方法

Publications (2)

Publication Number Publication Date
CN101508112A true CN101508112A (zh) 2009-08-19
CN101508112B CN101508112B (zh) 2010-12-29

Family

ID=41000721

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2009100300626A Expired - Fee Related CN101508112B (zh) 2009-03-30 2009-03-30 三自由度搬运工业机器人多目标优化设计参数的获取方法

Country Status (1)

Country Link
CN (1) CN101508112B (zh)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101673085A (zh) * 2009-09-21 2010-03-17 重庆大学 基于逆动力学模型的自适应pid控制器的设计方法
CN101829989A (zh) * 2010-04-29 2010-09-15 北京理工大学 基于区间分析的低自由度并联机器人多指标优化设计方法
CN103019096A (zh) * 2012-11-23 2013-04-03 北京理工大学 一种基于加速度优化的仿人机器人逆动力学控制器
CN103576687A (zh) * 2013-11-22 2014-02-12 中国科学院自动化研究所 一种机器人逆时针运动控制方法
CN103592945A (zh) * 2013-11-22 2014-02-19 中国科学院自动化研究所 一种机器人顺时针运动控制方法
CN104254430A (zh) * 2012-03-07 2014-12-31 佳能株式会社 机器人控制设备、机器人装置、机器人控制方法、用于执行机器人控制方法的程序、及在其上记录程序的记录介质
CN104749956A (zh) * 2015-03-24 2015-07-01 北京理工大学 基于和声搜索算法的工业机器人结构优化方法
CN111823226A (zh) * 2019-01-14 2020-10-27 牧今科技 具有协调机制的机器人系统及其操作方法
CN112199792A (zh) * 2020-09-30 2021-01-08 哈尔滨工程大学 一种微小型水下机器人多学科优化设计方法
CN112743556A (zh) * 2020-12-22 2021-05-04 中国消防救援学院 消防机器人多指标结构优化方法
CN112936279A (zh) * 2021-02-10 2021-06-11 大连理工大学 一种移动作业机器人目标抓取作业最短时间求解方法
CN112975965A (zh) * 2021-02-24 2021-06-18 深圳市优必选科技股份有限公司 仿人机器人的解耦控制方法、装置和仿人机器人
US11905116B2 (en) 2019-01-14 2024-02-20 Mujin, Inc. Controller and control method for robot system

Cited By (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101673085A (zh) * 2009-09-21 2010-03-17 重庆大学 基于逆动力学模型的自适应pid控制器的设计方法
CN101829989A (zh) * 2010-04-29 2010-09-15 北京理工大学 基于区间分析的低自由度并联机器人多指标优化设计方法
CN104254430B (zh) * 2012-03-07 2016-05-11 佳能株式会社 机器人控制设备、机器人装置及机器人控制方法和装置
CN104254430A (zh) * 2012-03-07 2014-12-31 佳能株式会社 机器人控制设备、机器人装置、机器人控制方法、用于执行机器人控制方法的程序、及在其上记录程序的记录介质
US9221174B2 (en) 2012-03-07 2015-12-29 Canon Kabushiki Kaisha Robot controlling device, robot apparatus, robot control method, program for executing robot control method, and recording medium on which program is recorded
CN103019096B (zh) * 2012-11-23 2015-09-16 北京理工大学 一种基于加速度优化的仿人机器人逆动力学控制器
CN103019096A (zh) * 2012-11-23 2013-04-03 北京理工大学 一种基于加速度优化的仿人机器人逆动力学控制器
CN103592945B (zh) * 2013-11-22 2016-08-17 中国科学院自动化研究所 一种机器人顺时针运动控制方法
CN103576687B (zh) * 2013-11-22 2016-01-06 中国科学院自动化研究所 一种机器人逆时针运动控制方法
CN103592945A (zh) * 2013-11-22 2014-02-19 中国科学院自动化研究所 一种机器人顺时针运动控制方法
CN103576687A (zh) * 2013-11-22 2014-02-12 中国科学院自动化研究所 一种机器人逆时针运动控制方法
CN104749956A (zh) * 2015-03-24 2015-07-01 北京理工大学 基于和声搜索算法的工业机器人结构优化方法
CN111823226A (zh) * 2019-01-14 2020-10-27 牧今科技 具有协调机制的机器人系统及其操作方法
US11905116B2 (en) 2019-01-14 2024-02-20 Mujin, Inc. Controller and control method for robot system
CN111823226B (zh) * 2019-01-14 2021-10-08 牧今科技 具有协调机制的机器人系统及其操作方法
CN112199792B (zh) * 2020-09-30 2021-07-20 哈尔滨工程大学 一种微小型水下机器人多学科优化设计方法
CN112199792A (zh) * 2020-09-30 2021-01-08 哈尔滨工程大学 一种微小型水下机器人多学科优化设计方法
CN112743556A (zh) * 2020-12-22 2021-05-04 中国消防救援学院 消防机器人多指标结构优化方法
CN112743556B (zh) * 2020-12-22 2024-03-26 中国消防救援学院 消防机器人多指标结构优化方法
CN112936279A (zh) * 2021-02-10 2021-06-11 大连理工大学 一种移动作业机器人目标抓取作业最短时间求解方法
CN112936279B (zh) * 2021-02-10 2023-09-19 大连理工大学 一种移动作业机器人目标抓取作业最短时间求解方法
CN112975965A (zh) * 2021-02-24 2021-06-18 深圳市优必选科技股份有限公司 仿人机器人的解耦控制方法、装置和仿人机器人

Also Published As

Publication number Publication date
CN101508112B (zh) 2010-12-29

Similar Documents

Publication Publication Date Title
CN101508112B (zh) 三自由度搬运工业机器人多目标优化设计参数的获取方法
CN109514602B (zh) 一种基于负载自适应辨识的工业机器人力矩补偿控制方法
CN108942924B (zh) 基于多层神经网络的模型不确定性机械臂运动控制方法
CN110065070B (zh) 一种基于动力学模型的机器人自适应阻抗控制系统
CN107544261B (zh) 不确定环境接触下的可重构机器人分散学习最优控制方法
CN101986564B (zh) 基于Backlash算子和神经网络的自适应滤波器
CN103853046B (zh) 一种压电陶瓷驱动器的自适应学习控制方法
CN110170992A (zh) 一种基于动态规划的模块化机械臂多故障容错控制方法
CN108527372B (zh) 一种变刚度串联弹性驱动器的机器人关节自适应控制方法
CN110103220A (zh) 机器人高速高精度运动轨迹规划方法、装置、设备及介质
Wu et al. Vibration reduction of delta robot based on trajectory planning
CN113296407A (zh) 一种基于5次非均匀有理b样条的多机协同轨迹优化方法
Wang et al. Dynamic performance analysis of parallel manipulators based on two-inertia-system
CN112936287B (zh) 一种基于动力学迭代学习的柔性机器人控制方法及装置
CN114310911B (zh) 基于神经网络的驱动关节动态误差预测与补偿系统及方法
CN114509949A (zh) 一种机器人预定性能的控制方法
CN105354433A (zh) 一种空间机械臂参数对运动可靠性影响比重的确定方法
Shang et al. Vibration suppression method based on PI fuzzy controller containing disturbance observe for dual-flexible manipulator with an axially translating arm
CN114169230A (zh) 一种机器人动力学参数的辨识方法
CN110549340A (zh) 重载码垛机器人频响特性分析方法及系统
Wu et al. A study on tracking error based on mechatronics model of a 5-DOF hybrid spray-painting robot
CN113733117B (zh) 一种可重构机器人人类意图辨识控制方法及装置
Shang et al. Model identification control strategy for coupled elastic joint flexible load drive system based on NNSMC controller and new deformation description
MOSTYN et al. DIMENSIONAL OPTIMIZATION OF THE ROBOTIC ARM TO REDUCE ENERGY CONSUMPTION.
CN110119085A (zh) 一种Manutec R3型工业机器人动态优化系统

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C17 Cessation of patent right
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20101229

Termination date: 20130330