專(zhuān)利名稱(chēng)：三自由度搬運(yùn)工業(yè)機(jī)器人多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的獲取方法
技術(shù)領(lǐng)域：
本發(fā)明涉及一種搬運(yùn)工業(yè)機(jī)器人設(shè)計(jì)參數(shù)的獲取方法，尤其涉及一種三自由度搬運(yùn)工業(yè)機(jī)器人多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的獲取方法。

背景技術(shù)：
工業(yè)機(jī)器人是一種典型的復(fù)雜系統(tǒng)，對(duì)于一個(gè)復(fù)雜系統(tǒng)的設(shè)計(jì)優(yōu)化而言，其主要特點(diǎn)為由于復(fù)雜工程系統(tǒng)通常包含若干個(gè)具有特定功能的子系統(tǒng)，系統(tǒng)和子系統(tǒng)都有各自相應(yīng)的設(shè)計(jì)目標(biāo)、設(shè)計(jì)參數(shù)和約束條件，同時(shí)又由于子系統(tǒng)之間存在復(fù)雜的耦合關(guān)系，因此復(fù)雜工程系統(tǒng)的設(shè)計(jì)過(guò)程已經(jīng)成為一個(gè)多學(xué)科交叉綜合設(shè)計(jì)的多目標(biāo)優(yōu)化決策過(guò)程。由最優(yōu)組件和子系統(tǒng)組成的大系統(tǒng)，并不一定是整體性能最優(yōu)的系統(tǒng)。因此，復(fù)雜工程系統(tǒng)的設(shè)計(jì)過(guò)程需要能夠兼顧不同因素之間復(fù)雜耦合關(guān)系的優(yōu)化理論與方法的支持。
在工業(yè)機(jī)器人的設(shè)計(jì)中，機(jī)械系統(tǒng)設(shè)計(jì)影響傳動(dòng)系統(tǒng)、控制系統(tǒng)的設(shè)計(jì)，傳動(dòng)系統(tǒng)設(shè)計(jì)影響控制系統(tǒng)的設(shè)計(jì)，同時(shí)，控制系統(tǒng)設(shè)計(jì)又影響機(jī)械系統(tǒng)和傳動(dòng)系統(tǒng)設(shè)計(jì)。但是，在傳統(tǒng)工業(yè)機(jī)器人設(shè)計(jì)流程中，機(jī)械系統(tǒng)、傳動(dòng)系統(tǒng)、控制系統(tǒng)的設(shè)計(jì)依次單獨(dú)進(jìn)行，因而上游子系統(tǒng)設(shè)計(jì)無(wú)法兼顧下游子系統(tǒng)設(shè)計(jì)的設(shè)計(jì)指標(biāo)，下游子系統(tǒng)設(shè)計(jì)也無(wú)法兼顧上游子系統(tǒng)設(shè)計(jì)的設(shè)計(jì)指標(biāo)，從而影響了系統(tǒng)整體性能的提高。


發(fā)明內(nèi)容
本發(fā)明提供一種能夠?qū)崿F(xiàn)并行優(yōu)化的三自由度搬運(yùn)工業(yè)機(jī)器人多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的獲取方法。
本發(fā)明采用如下技術(shù)方案 步驟1建立機(jī)械臂運(yùn)動(dòng)學(xué)模型、強(qiáng)度分析模型、基于機(jī)電耦合系統(tǒng)動(dòng)力學(xué)模型及逆動(dòng)力學(xué)控制的系統(tǒng)閉環(huán)模型，并使用機(jī)械臂運(yùn)動(dòng)學(xué)模型獲得第一機(jī)械臂(1)、第二機(jī)械臂(2)及第三機(jī)械臂(3)的工作空間性能指標(biāo) J1＝λ1Rmin-λ2Rmax＝f1(l2，l3)， 其中，Rmin為工作空間最小半徑，Rmax為工作空間最大半徑，λ1、λ2分別為最小半徑與最大半徑的權(quán)系數(shù)，l2為第二機(jī)械臂的臂長(zhǎng)，l3為第三機(jī)械臂的臂長(zhǎng)； 使用強(qiáng)度分析模型獲得涉及第二機(jī)械臂(2)及第三機(jī)械臂(3)的綜合強(qiáng)度性能指標(biāo) 其中，[σ]為第二機(jī)械臂(2)及第三機(jī)械臂(3)所用材料的許用彎曲應(yīng)力；σ2max、σ3max分別表示在機(jī)器人運(yùn)動(dòng)過(guò)程中，第二機(jī)械臂(2)及第三機(jī)械臂(3)上的最大應(yīng)力；|σ2max-0.8[σ]|、|σ3max-0.8[σ]|分別表示機(jī)器人運(yùn)動(dòng)過(guò)程中，第二機(jī)械臂(2)及第三機(jī)械臂(3)上的最大應(yīng)力與材料許用彎曲應(yīng)力的0.8倍的接近程度，l1為第一機(jī)械臂的臂長(zhǎng)，b2、h2為第二機(jī)械臂(2)外截面的寬度及高度，b2e、h2e為第二機(jī)械臂(2)內(nèi)腔的寬度及高度，b3、h3為第三機(jī)械臂(3)外截面的寬度及高度，b3e、h3e為第三機(jī)械臂(3)內(nèi)腔的寬度及高度，

分別為第二關(guān)節(jié)、第三關(guān)節(jié)的最大角加速度，

分別為第一關(guān)節(jié)、第二關(guān)節(jié)、第三關(guān)節(jié)的最大角速度，7×107為比例系數(shù)； 使用系統(tǒng)閉環(huán)模型獲得第一機(jī)械臂(1)、第二機(jī)械臂(2)及第三機(jī)械臂(3)的平均控制能量指標(biāo) 及平均控制時(shí)間指標(biāo) 其中，200是指在給定設(shè)計(jì)要求的工作空間中隨機(jī)選取400個(gè)點(diǎn)作為搬運(yùn)任務(wù)的起止點(diǎn)，由此組成200組搬運(yùn)任務(wù)工作點(diǎn)；n表示第n組搬運(yùn)任務(wù)，mLn表示第n組搬運(yùn)任務(wù)的負(fù)載質(zhì)量，|θ1n|、|θ2n|、|θ3n|分別表示表示完成第n組搬運(yùn)任務(wù)第一關(guān)節(jié)、第二關(guān)節(jié)及第三關(guān)節(jié)的轉(zhuǎn)動(dòng)角度，τ1(t)、τ2(t)、τ3(t)分別表示完成第n組搬運(yùn)任務(wù)第一關(guān)節(jié)、第二關(guān)節(jié)及第三關(guān)節(jié)在t時(shí)刻輸出的電磁轉(zhuǎn)矩，tfn表示完成第n組搬運(yùn)任務(wù)的完成時(shí)間，R1、r1分別為圓筒形的第一機(jī)械臂(1)外半徑及內(nèi)半徑，

為第一關(guān)節(jié)的最大角加速度； 步驟2對(duì)工作空間性能指標(biāo)、綜合強(qiáng)度性能指標(biāo)、平均控制能量指標(biāo)及平均控制時(shí)間指標(biāo)涉及的參數(shù)進(jìn)行選擇性優(yōu)化，并建立多目標(biāo)并行優(yōu)化模型 首先，選擇參數(shù)l2、l3、b2、h2、b3、h3、

作為設(shè)計(jì)變量，對(duì) 工作空間性能指標(biāo) J1＝λ1Rmin-λ2Rmax， 綜合強(qiáng)度性能指標(biāo) J2＝|σ2Zmax-0.8[σ]|+|σ3Zmax-0.8[σ]|， 平均控制能量指標(biāo) 及平均控制時(shí)間指標(biāo) 進(jìn)行同時(shí)優(yōu)化，得到多目標(biāo)優(yōu)化設(shè)計(jì)任務(wù) 其中，x1是由設(shè)計(jì)變量l2、l3組成的向量，稱(chēng)之為臂長(zhǎng)設(shè)計(jì)向量，其中，

的下標(biāo)1表示設(shè)計(jì)向量x1，上標(biāo)1表示設(shè)計(jì)向量x1的第一分量，

的下標(biāo)1表示設(shè)計(jì)向量x1，上標(biāo)2表示設(shè)計(jì)向量x1的第二分量；x2是由設(shè)計(jì)變量b2、h2、b3、h3組成的向量，稱(chēng)之為臂的厚度設(shè)計(jì)向量，其中，

的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)1表示設(shè)計(jì)向量x2的第一分量，

的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)2表示設(shè)計(jì)向量x2的第二分量，

的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)3表示設(shè)計(jì)向量x2的第三分量，

的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)4表示設(shè)計(jì)向量x2的第四分量；x3是由設(shè)計(jì)變量組成的向量，稱(chēng)之為關(guān)節(jié)的運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)1表示設(shè)計(jì)向量x3的第一分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)2表示設(shè)計(jì)向量x3的第二分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)3表示設(shè)計(jì)向量x3的第三分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)4表示設(shè)計(jì)向量x3的第四分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)5表示設(shè)計(jì)向量x3的第五分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)6表示設(shè)計(jì)向量x3的第六分量；φ1為第一約束條件向量，φ1＝[(l2—l3)—dmin，dmax—(l2+l3)，l3—l2，—l2，—l3]T，這里，dmin＝0.2，dmax＝1.5，分別代表對(duì)所設(shè)計(jì)的機(jī)械臂工作空間最小半徑與最大半徑的設(shè)計(jì)要求，其值根據(jù)具體的設(shè)計(jì)需要進(jìn)行調(diào)整；φ2為第二約束條件向量，φ2＝[h2e-h2，b2e-b2，h3e-h3，b3e-b3]T；φ3為第三約束條件向量 其次，將約束條件與工作空間性能指標(biāo)J1、綜合強(qiáng)度性能指標(biāo)J2、平均控制能量指標(biāo)J3及平均控制時(shí)間指標(biāo)J4進(jìn)行合并轉(zhuǎn)化，得到廣義工作空間性能指標(biāo)Z1，廣義綜合強(qiáng)度性能指標(biāo)Z2，廣義平均控制能量指標(biāo)Z3及廣義平均控制時(shí)間指標(biāo)Z4 其中，

分別是工作空間性能指標(biāo)J1、綜合強(qiáng)度性能指標(biāo)J2、平均控制能量指標(biāo)J3及平均控制時(shí)間指標(biāo)J4的期望值，

分別表示第一約束條件向量的第m個(gè)元素、第二約束條件向量的第m個(gè)元素、第三約束條件向量的第m個(gè)元素；σ1為第一罰系數(shù)，σ1＝1000；σ2為第二罰系數(shù)，σ2＝1000；σ3為第三罰系數(shù)，σ3＝1000； 步驟3用控制方法獲得多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù) 建立第一控制律 其中，v1，i為第i次迭代時(shí)臂長(zhǎng)設(shè)計(jì)向量x1的調(diào)整量，

的第一下標(biāo)1和上標(biāo)1表示該調(diào)整量是對(duì)設(shè)計(jì)向量x1中的第一設(shè)計(jì)變量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)1和上標(biāo)2表示該調(diào)整量是對(duì)設(shè)計(jì)向量x1中的第二設(shè)計(jì)變量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)； 對(duì)第一控制律產(chǎn)生的調(diào)整量v1，i的調(diào)整幅度進(jìn)行修正 如果 如果 其中，

表示設(shè)計(jì)向量x1的第一設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x1的第二設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值； 用修正后的調(diào)整值v1，i調(diào)整臂長(zhǎng)設(shè)計(jì)向量x1，得到第i次迭代后設(shè)計(jì)向量x1的值x1，i＝x1，i-1+v1，i；e1，i-1為廣義工作空間性能指標(biāo)Z1在第i—1次迭代后的值Z1，i-1與目標(biāo)值0的誤差，e1，i-1＝0—Z1，i-1； e2，i-1為廣義綜合強(qiáng)度性能指標(biāo)Z2在第i—1次迭代后的值Z2，i-1與目標(biāo)值0的誤差，e2，i-1＝0—Z2，i-1； e3，i-1為廣義平均控制能量指標(biāo)Z3在第i—1次迭代后的值Z3，i-1與目標(biāo)值0的誤差，e3，i-1＝0—Z3，i-1； e4，i-1為廣義平均控制時(shí)間指標(biāo)Z4在第i—1次迭代后的值Z4，i-1與目標(biāo)值0的誤差，e4，i-1＝0—Z4，i-1；

為誤差值e1，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

的上標(biāo)1表示廣義工作空間性能指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義工作空間性能指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e2，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

的上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義綜合強(qiáng)度性能指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e3，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)3表示廣義平均控制能量指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制能量性能指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e4，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制時(shí)間指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e1，i-1在控制律1中的比例系數(shù)，

上標(biāo)1表示廣義工作空間性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令

為誤差值e2，i-1在控制律1中的比例系數(shù)，

上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令

為誤差值e3，i-1在控制律1中的比例系數(shù)，

上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令

為誤差值e4，i-1在控制律1中的比例系數(shù)，

上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令 建立第二控制律 其中，v2，i為第i次迭代時(shí)臂厚設(shè)計(jì)向量x2的調(diào)整量，

的第一下標(biāo)2和上標(biāo)1表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第一設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)2和上標(biāo)2表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第二設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)2和上標(biāo)3表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第三設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)2和上標(biāo)4表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第四設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)； 對(duì)第二控制律產(chǎn)生的調(diào)整量v2，i的調(diào)整幅度進(jìn)行修正 如果 如果 其中，

表示設(shè)計(jì)向量x2的第一設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x2的第二設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x2的第三設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x2的第四設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值； 用修正后的調(diào)整值v2，i調(diào)整臂厚設(shè)計(jì)向量，得到第i次迭代后設(shè)計(jì)向量x2的值x2，i＝x2，i-1+v2，i；

為誤差值e2，i-1相對(duì)于設(shè)計(jì)向量值x2，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

的上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，第一下標(biāo)2表示臂厚設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義綜合強(qiáng)度性能指標(biāo)的誤差值及臂厚設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e3，i-1相對(duì)于設(shè)計(jì)向量值x2，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，第一下標(biāo)2表示臂厚設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制能量指標(biāo)的誤差值及臂厚設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差e2，i-1在控制律2中的比例系數(shù)，

上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，下標(biāo)2表示控制律2，并且令

為誤差e3，i-1在控制律2中的比例系數(shù)，

上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，下標(biāo)2表示控制律1，并且令 建立第三控制律 其中，v3，i為第i次迭代時(shí)關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的調(diào)整量，

的第一下標(biāo)3和上標(biāo)1表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第一設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)3和上標(biāo)2表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第二個(gè)設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)3和上標(biāo)3表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第三設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)3和上標(biāo)4表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第四設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)；

的第一下標(biāo)3和上標(biāo)5表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第五設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)；

的第一下標(biāo)3和上標(biāo)6表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第六設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)； 對(duì)第三控制律產(chǎn)生的調(diào)整量v3，i的調(diào)整幅度進(jìn)行修正 如果 如果 其中，

表示設(shè)計(jì)向量x3的第一設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第二設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第三設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第四設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第五設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第六設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值； 用修正后的調(diào)整量v3，i調(diào)整關(guān)節(jié)的運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3，計(jì)算第i次迭代后設(shè)計(jì)向量x3的值x3，i＝x3，i-1+v3，i；

為誤差值e2，i-1相對(duì)于設(shè)計(jì)向量值x3，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

的上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，第一下標(biāo)3表示設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義綜合強(qiáng)度性能指標(biāo)的誤差值及運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e3，i-1相對(duì)于設(shè)計(jì)向量值x3，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，第一下標(biāo)3表示運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制能量性能指標(biāo)的誤差值及運(yùn)動(dòng)學(xué)能力向量的值為第i—1次迭代后的值；

為誤差值e4，i-1相對(duì)于設(shè)計(jì)向量值x3，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，第一下標(biāo)3表示設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制時(shí)間性能指標(biāo)的誤差值及運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e2，i-1在控制律3中的比例系數(shù)，

上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，下標(biāo)3表示控制律3，并且令

為誤差值e3，i-1在控制律3中的比例系數(shù)，

上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，下標(biāo)3表示控制律3，并且令

為誤差值e4，i-1在控制律4中的比例系數(shù)，

上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，下標(biāo)4表示控制律4，并且令 利用第一控制律、第二控制律、第三控制律對(duì)臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3進(jìn)行第一次優(yōu)化設(shè)計(jì) 為臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3賦初始設(shè)計(jì)值，得到向量x1，0、向量x2，0、向量x3，0； 為各性能指標(biāo)期望值

賦第一次多目標(biāo)優(yōu)化設(shè)計(jì)的參考值


得到對(duì)于

其第一下標(biāo)1表示工作空間性能表，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)，對(duì)于

其第一下標(biāo)2表示綜合強(qiáng)度性能指標(biāo)，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)，對(duì)于

其第一下標(biāo)3表示平均控制能量指標(biāo)，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)，對(duì)于

其第一下標(biāo)4表示平均控制時(shí)間指標(biāo)，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)； 由第一次多目標(biāo)優(yōu)化設(shè)計(jì)的參考值

及x1，0、x2，0、x3，0計(jì)算得到各廣義性能指標(biāo)的初始值Z1，0、Z2，0、Z3，0、Z4，0；如果Z1，0、Z2，0、Z3，0、Z4，0不全部為零，則進(jìn)入步驟3.1；如果Z1，0、Z2，0、Z3，0、Z4，0全部為零，則設(shè)計(jì)向量x1、x2、x3的初始值x1，0、x2，0、x3，0即為多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的值； 步驟3.1對(duì)設(shè)計(jì)變量組成的向量x1、x2、x3進(jìn)行第一次迭代，迭代次數(shù)i＝1 首先，由第一控制律及對(duì)第一控制律產(chǎn)生的調(diào)整量v1，1幅度修正方法 如果 如果 生成對(duì)向量x1的第一次迭代的調(diào)整值v1，1，再用調(diào)整值v1，1調(diào)整向量x1，得到向量x1第一次迭代后的值x1，1＝x1，0+v1，1；這里，e1，0為廣義工作空間性能指標(biāo)在初始時(shí)刻的值Z1，0與目標(biāo)值0的誤差，e1，0＝0—Z1，0；e2，0為廣義綜合強(qiáng)度性能指標(biāo)在初始時(shí)刻的值Z2，0與目標(biāo)值0的誤差，e2，0＝0—Z2，0；e3，0為廣義平均控制能量指標(biāo)在初始時(shí)刻的值Z3，0與目標(biāo)值0的誤差，e3，0＝0—Z2，0；e4，0為廣義平均控制時(shí)間指標(biāo)在初始時(shí)刻的值Z4，0與目標(biāo)值0的誤差，e4，0＝0—Z4，0；

為誤差值e1，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e2，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e4，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 其次，由第二控制律及對(duì)第二控制律產(chǎn)生的調(diào)整量v2，1的幅度修正方法 如果 如果 生成對(duì)臂厚設(shè)計(jì)向量x2的第一次迭代的調(diào)整值v2，1，用調(diào)整值v2，1調(diào)整臂厚設(shè)計(jì)向量x2，得到向量x2的第一次迭代后的值x2，1＝x2，0+v2，1；這里，

為誤差值e2，0相對(duì)于設(shè)計(jì)向量值x2，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，0相對(duì)于設(shè)計(jì)向量值x2，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 再次，由第三控制律及對(duì)第三控制律產(chǎn)生的調(diào)整量v3，1的幅度修正方法 如果 如果 生成對(duì)關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的第一次調(diào)整值v3，1，用調(diào)整值v3，1調(diào)整關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3，得到設(shè)計(jì)向量x3的第一次迭代后的值x3，1＝x3，0+v3，1；這里，

為誤差值e2，0相對(duì)于x3，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，0相對(duì)于設(shè)計(jì)向量值x3，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e4，0相對(duì)于設(shè)計(jì)向量值x3，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 最后，在得到設(shè)計(jì)向量x1、x2、x3的第一次迭代后的向量值x1，1、x2，1、x3，1之后，計(jì)算第一次調(diào)整后各廣義性能的值Z1，1、Z2，1、Z3，1、Z4，1，如果Z1，1、Z2，1、Z3，1、Z4，1不全部為零，則進(jìn)入步驟3.2；如果Z1，1、Z2，1、Z3，1、Z4，1全部為零，則所得到的向量x1、x2、x3的第一次迭代的值x1，1、x2，1、x3，1為多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)； 步驟3.2對(duì)設(shè)計(jì)變量組成的向量x1、x2、x3進(jìn)行第二次迭代，迭代次數(shù)i＝2首先，由第一控制律及對(duì)第一控制律產(chǎn)生的調(diào)整量v1，2幅度修正方法 如果 如果 生成對(duì)向量x1的第二次迭代的調(diào)整值v1，2，再用調(diào)整值v1，2調(diào)整向量x2，得到第二次迭代后設(shè)計(jì)向量x1的值x1，2＝x1，1+v1，2；這里，e1，1為廣義工作空間性能指標(biāo)在第一次迭代后的值Z1，1與目標(biāo)值0的誤差，e1，1＝0—Z1，1；e2，1為廣義綜合強(qiáng)度性能指標(biāo)在第一次迭代后的值Z2，1與目標(biāo)值0的誤差，e2，1＝0—Z2，1；e3，1為廣義平均控制能量性能指標(biāo)在第一次迭代后的值Z3，1與目標(biāo)值0的誤差，e3，1＝0—Z3，1；e4，1為廣義平均控制能量性能指標(biāo)在第一次迭代后的值Z4，1與目標(biāo)值0的誤差，e4，1＝0—Z4，1；

為誤差值e1，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e2，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e4，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 其次，由第二控制律及對(duì)第二控制律產(chǎn)生的調(diào)整量v2，2的幅度修正方法 如果 如果 生成設(shè)計(jì)向量x2進(jìn)行第二次迭代的調(diào)整值再用調(diào)整值v2，2調(diào)整設(shè)計(jì)向量x2的值，得到第二次迭代后設(shè)計(jì)向量x2的值x2，2＝x2，1+v2，2；這里，

為誤差值e2，1相對(duì)于設(shè)計(jì)向量值x2，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，1相對(duì)于設(shè)計(jì)向量值x2，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 再次，由第三控制律及對(duì)第三控制律產(chǎn)生的調(diào)整量v3，2的幅度修正方法 如果 如果 生成設(shè)計(jì)向量x3的第二次迭代的調(diào)整值，再用調(diào)整值v3，2調(diào)整設(shè)計(jì)向量x3的值，得到第二次迭代后向量x3的值x3，2＝x3，1+v3，2；這里，

為e2，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e4，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 最后，用得到的設(shè)計(jì)向量x1、x2、x3第二次迭代后的值x1，2、x2，2、x3，2，計(jì)算第二次迭代后各廣義性能的值Z1，2、Z2，2、Z3，2、Z4，2，如果Z1，2、Z2，2、Z3，2、Z4，2不全部為零，則進(jìn)入步驟3.3；如果Z1，2、Z2，2、Z3，2、Z4，2全部為零，則所得到的向量x1、x2、x3的第二次迭代的值x1，2、x2，2、x3，2即為多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的值； 步驟3.3依此類(lèi)推，通過(guò)第一控制律及對(duì)第一控制律產(chǎn)生的調(diào)整量幅度的修正方法，生成設(shè)計(jì)向量x1進(jìn)行第j次迭代的調(diào)整值v1，j；通過(guò)第二控制律及對(duì)第二控制律產(chǎn)生的調(diào)整量幅度的修正方法，生成設(shè)計(jì)向量x2進(jìn)行第j次迭代的調(diào)整值v2，j；通過(guò)第三控制律及對(duì)第三控制律產(chǎn)生的調(diào)整量幅度的修正方法，生成設(shè)計(jì)向量x3進(jìn)行第j次迭代的調(diào)整值v3，j；重復(fù)上述迭代，如果在100次迭代內(nèi)通過(guò)調(diào)整臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的值可以使廣義工作空間性能指標(biāo)Z1、廣義綜合強(qiáng)度性能指標(biāo)Z2、廣義平均控制能量指標(biāo)Z3、廣義平均控制時(shí)間指標(biāo)Z4的值同時(shí)為零，則獲得最終獲得使各性能同時(shí)得到優(yōu)化的臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的設(shè)計(jì)值；如果在100次迭代內(nèi)無(wú)法使得廣義工作空間性能指標(biāo)Z1、廣義綜合強(qiáng)度性能指標(biāo)Z2、廣義平均控制能量指標(biāo)Z3、廣義平均控制時(shí)間指標(biāo)Z4的值同時(shí)為零，則進(jìn)入步驟3.4，直到各廣義性能在100次迭代內(nèi)使得廣義性能指標(biāo)Z1、Z2、Z3、Z4的值同時(shí)為零，獲得最終獲得使各性能同時(shí)得到優(yōu)化的臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的最終設(shè)計(jì)值； 步驟3.4對(duì)各性能指標(biāo)期望值

的期望值進(jìn)行第n—1次調(diào)整后進(jìn)行第n次優(yōu)化設(shè)計(jì)，令n為優(yōu)化設(shè)計(jì)的次數(shù)，對(duì)設(shè)計(jì)向量x1、x2、x3進(jìn)行第n次優(yōu)化設(shè)計(jì)，重復(fù)步驟3.1～步驟3.3。
與現(xiàn)有技術(shù)相比，本發(fā)明具有如下優(yōu)點(diǎn) 1.本發(fā)明通過(guò)明確多目標(biāo)優(yōu)化設(shè)計(jì)任務(wù)將搬運(yùn)機(jī)器人的機(jī)械系統(tǒng)設(shè)計(jì)、驅(qū)動(dòng)系統(tǒng)設(shè)計(jì)由上下游設(shè)計(jì)關(guān)系轉(zhuǎn)化為并行設(shè)計(jì)過(guò)程，從而兼顧了各子系統(tǒng)設(shè)計(jì)對(duì)機(jī)器人性能產(chǎn)生的影響，為全面優(yōu)化機(jī)器人的工作空間性能、強(qiáng)度性能以及控制性能提供了方法。
2.通過(guò)將約束條件與優(yōu)化目標(biāo)進(jìn)行合并轉(zhuǎn)化，得到四個(gè)廣義多目標(biāo)優(yōu)化指標(biāo) 從而將多目標(biāo)多目標(biāo)優(yōu)化目標(biāo)轉(zhuǎn)化為使四個(gè)廣義性能指標(biāo)同時(shí)趨于零。
3.針對(duì)轉(zhuǎn)化后的多目標(biāo)優(yōu)化設(shè)計(jì)問(wèn)題，提出了一種通過(guò)控制方法解決多目標(biāo)優(yōu)化問(wèn)題的新方法。通過(guò) 第一控制律 第二控制律 第三控制律 分別建立臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3在第i次迭代的初始控制量。
4.通過(guò)建立控制律中誤差系數(shù)的設(shè)置原則，實(shí)現(xiàn)控制律調(diào)整方向的協(xié)調(diào)。對(duì)于三個(gè)控制律，誤差系數(shù)整定原則為 在第一控制律中，通過(guò)系數(shù)

的整定，保證在第i次迭代調(diào)整x1的設(shè)計(jì)值時(shí)，

對(duì)應(yīng)的調(diào)整方向，即使Z1收斂至零的方向作為優(yōu)先級(jí)最高的調(diào)整方向；第二級(jí)，

對(duì)應(yīng)的調(diào)整方向，即使Z2收斂至零的方向作為優(yōu)先級(jí)次高的調(diào)整方向；

對(duì)應(yīng)的調(diào)整方向，即使Z3、Z4收斂至零的方向作為優(yōu)先級(jí)最低的調(diào)整方向，對(duì)同處于最低優(yōu)先級(jí)


對(duì)應(yīng)的調(diào)整方向，規(guī)定

對(duì)應(yīng)的調(diào)整方向優(yōu)先級(jí)高于

對(duì)應(yīng)的調(diào)整方向。
在第二控制律中，通過(guò)系數(shù)

的整定，保證在第i次迭代調(diào)整x2的設(shè)計(jì)值時(shí)，

對(duì)應(yīng)的調(diào)整方向，即使Z2收斂至零的方向，作為優(yōu)先級(jí)高的調(diào)整方向；

對(duì)應(yīng)的調(diào)整方向，即使Z3收斂至零的方向，作為優(yōu)先級(jí)低的調(diào)整方向。
在第三控制律中，通過(guò)系數(shù)

的整定，保證在第i次迭代調(diào)整x3的設(shè)計(jì)值時(shí)，

對(duì)應(yīng)的調(diào)整方向，即使Z3、Z4收斂至零的方向作為高優(yōu)先級(jí)的調(diào)整方向，對(duì)同處于高優(yōu)先級(jí)

對(duì)應(yīng)的調(diào)整方向，規(guī)定

對(duì)應(yīng)的調(diào)整方向優(yōu)先級(jí)高于

對(duì)應(yīng)的調(diào)整方向；

對(duì)應(yīng)的調(diào)整方向，即使Z2收斂至零的方向作為優(yōu)先級(jí)低的調(diào)整方向。
同時(shí)規(guī)定，在第一控制律、第二控制律、第三控制律中優(yōu)先級(jí)高的廣義性能指標(biāo)不收斂到零之前，相應(yīng)的設(shè)計(jì)變量一直按照該廣義性能指標(biāo)收斂到零的方向調(diào)整。當(dāng)優(yōu)先級(jí)高的廣義性能指標(biāo)收斂到零之后，相應(yīng)的設(shè)計(jì)變量按照優(yōu)先級(jí)相對(duì)較高的廣義性能指標(biāo)收斂到零的方向調(diào)整，依次進(jìn)行，直到所有廣義性能指標(biāo)都收斂到零。
5.通過(guò)設(shè)計(jì)對(duì)三個(gè)控制律生成的控制量幅度的調(diào)整方法，解決了用控制方法進(jìn)行多目標(biāo)優(yōu)化設(shè)計(jì)時(shí)各廣義性能指標(biāo)的值不收斂到目標(biāo)值零的問(wèn)題。
用控制方法進(jìn)行多目標(biāo)優(yōu)化設(shè)計(jì)時(shí)各廣義性能指標(biāo)的值不收斂到目標(biāo)值零主要由于三種情況引起 原因一是對(duì)設(shè)計(jì)變量的調(diào)整量過(guò)大；原因二是對(duì)設(shè)計(jì)變量的調(diào)整量過(guò)?。辉蛉怯捎趯?duì)各性能指標(biāo)的期望值設(shè)置不合理。針對(duì)原因一、原因二提出控制量幅度的調(diào)整方法。
為防止控制量幅度過(guò)大或過(guò)小提出 對(duì)于第一控制律生成的第i次迭代的調(diào)整量的幅度進(jìn)行修正的方法為 如果 如果 對(duì)于第二控制律生成的第i次迭代的調(diào)整量的幅度進(jìn)行修正的方法為 如果 如果 對(duì)于第三控制律，生成的第i次迭代的調(diào)整量的幅度進(jìn)行修正的方法為 如果 如果 6.對(duì)三自由度搬運(yùn)機(jī)器人的基本設(shè)計(jì)要求為該三自由度工業(yè)機(jī)器人的工作空間為以(0，0，1)為球心，最大半徑Rmax＝1.5，最小半徑Rmin＝0.2的兩球之間的部分(單位m)。要求搬運(yùn)的最大負(fù)載質(zhì)量為25kg。在此基礎(chǔ)上，要求工作空間最大化，強(qiáng)度滿足材料要求，機(jī)械臂控制過(guò)程能量、時(shí)間性能最優(yōu)。對(duì)于本設(shè)計(jì)任務(wù)，提給定預(yù)先設(shè)計(jì)參數(shù)的值分別為l1＝1、R1＝0.075、r1＝0.05、h2e＝0.08、b2e＝0.08、h3e＝0.08、b3e＝0.08(單位m)。下面開(kāi)始臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的設(shè)計(jì)。
首先，初始化各設(shè)計(jì)變量。
x1＝
T，x2＝
T，x3＝[5，5，5，3，3，3]T。
計(jì)算初始化設(shè)計(jì)變量下機(jī)械臂各性能為 J1＝—1.2，J2＝1.3879，J3＝1.6411，J4＝0.4393。
結(jié)合機(jī)械臂初始性能，給定各性能最終優(yōu)化的次最優(yōu)指標(biāo) 經(jīng)過(guò)24次疊代，各性能都達(dá)到各性能可接受的性能值。優(yōu)化前后各設(shè)計(jì)變量的變化以及性能指標(biāo)的變化可通過(guò)表1及表2所示。
表1 優(yōu)化設(shè)計(jì)前后設(shè)計(jì)變量設(shè)計(jì)值的變化 表2 優(yōu)化設(shè)計(jì)前后各性能值的變化


圖1是本發(fā)明的三自由度機(jī)器人及其連桿坐標(biāo)系圖。
圖2是本發(fā)明獲得多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的控制方法框圖。
圖3是本發(fā)明設(shè)計(jì)實(shí)例2中廣義性能指標(biāo)1在設(shè)計(jì)過(guò)程中的變化情況圖。
圖4是本發(fā)明設(shè)計(jì)實(shí)例2中廣義性能指標(biāo)2在設(shè)計(jì)過(guò)程中的變化情況圖。
圖5是本發(fā)明設(shè)計(jì)實(shí)例2中廣義性能指標(biāo)3在設(shè)計(jì)過(guò)程中的變化情況圖。
圖6是本發(fā)明設(shè)計(jì)實(shí)例2中廣義性能指標(biāo)4在設(shè)計(jì)過(guò)程中的變化情況圖。
圖7是本發(fā)明的多目標(biāo)優(yōu)化設(shè)計(jì)步驟框圖。
圖8多目標(biāo)優(yōu)化設(shè)計(jì)步驟3的框圖。

具體實(shí)施例方式 實(shí)施例1 1.一種三自由度搬運(yùn)工業(yè)機(jī)器人多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的獲取方法，所述的三自由度搬運(yùn)工業(yè)機(jī)器人包括第一機(jī)械臂(1)、第二機(jī)械臂(2)及第三機(jī)械臂(3)，第二機(jī)械臂(2)的兩端分別與第一機(jī)械臂(1)的一端、第三機(jī)械臂(3)的一端轉(zhuǎn)動(dòng)連接，其特征在于多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的獲取方法含有以下步驟 步驟1首先，建立該三自由度機(jī)械臂的連桿坐標(biāo)系，如圖1所示；由該機(jī)械臂運(yùn)動(dòng)學(xué)方程，可得末端工作點(diǎn)的軌跡為設(shè)各轉(zhuǎn)角范圍設(shè)計(jì)為-π≤θ1≤π，-π≤θ2≤π，-π≤θ3≤π則機(jī)械臂的工作空間是一簇以(0，0，l1)為球心，半徑的同心球；設(shè)其中半徑最小的球半徑為Rmin，并規(guī)定l2≥l3，則Rmin＝l2-l3；設(shè)半徑最大球的半徑為Rmax，則Rmax＝l2+l3；則J1＝λ1Rmin-λ2Rmax＝(λ1-λ2)l2-(λ1+λ2)l3。
使用機(jī)械臂運(yùn)動(dòng)學(xué)模型獲得第一機(jī)械臂(1)、第二機(jī)械臂(2)及第三機(jī)械臂(3)的工作空間性能指標(biāo) J1＝λ1Rmin-λ2Rmax＝f1(l2，l3)， 其中，Rmin為工作空間最小半徑，Rmax為工作空間最大半徑，λ1、λ2分別為最小半徑與最大半徑的權(quán)系數(shù)，l2為第二機(jī)械臂的臂長(zhǎng)，l3為第三機(jī)械臂的臂長(zhǎng)。
其次，通過(guò)以下五個(gè)步驟建立第二機(jī)械臂(2)及第三機(jī)械臂(3)的強(qiáng)度分析模型 第一，將第二機(jī)械臂(2)、第三機(jī)械臂(3)各自等分成K2、K3個(gè)單元，為了利用有限元模型分析第二機(jī)械臂(2)、第三機(jī)械臂(3)受力情況的精確性，K2、K3取值要求K2≥5000、K3≥5000； 第二，利用有限元模型，對(duì)第二機(jī)械臂(2)、第三機(jī)械臂(3)在機(jī)器人運(yùn)動(dòng)過(guò)程中由各單元所受慣性力組成的慣性力系分別在第三關(guān)節(jié)及第二關(guān)節(jié)處，即連桿坐標(biāo)系中點(diǎn)o2、o1處進(jìn)行簡(jiǎn)化。根據(jù)牽連運(yùn)動(dòng)為轉(zhuǎn)動(dòng)時(shí)點(diǎn)的加速度合成定理，可求得第二機(jī)械臂(2)、第三機(jī)械臂(3)各單元在機(jī)器人運(yùn)動(dòng)時(shí)的加速度其中

為單元i的絕對(duì)加速度，

為單元i的牽連加速度，

為單元i的相對(duì)加速度，

為單元i的科氏加速度，則慣性力系即為各單元在運(yùn)動(dòng)過(guò)程中產(chǎn)生的慣性力的綜合作用，mi為單元i的質(zhì)量，對(duì)于第二機(jī)械臂(2)各單元的慣性力系在第二關(guān)節(jié)處簡(jiǎn)化為主矢

主矩為

對(duì)于第三機(jī)械臂(3)各單元的慣性力系在第三關(guān)節(jié)處簡(jiǎn)化為主矢

主矩為
第三，根據(jù)對(duì)第二機(jī)械臂(2)、第三機(jī)械臂(3)在機(jī)器人運(yùn)動(dòng)過(guò)程中由各單元所受慣性力組成的慣性力系分別在第三關(guān)節(jié)及第二關(guān)節(jié)處簡(jiǎn)化得到的慣性力主矢與主矩以及質(zhì)點(diǎn)系的達(dá)朗貝爾定理，分別求得關(guān)節(jié)3及關(guān)節(jié)2處產(chǎn)生的支反力及支反力偶； 第四，根據(jù)其次通過(guò)截面法求得機(jī)械臂2及3上各單元處的彎矩； 第五，經(jīng)過(guò)分析可知，各機(jī)械臂關(guān)節(jié)處的單元在機(jī)械臂運(yùn)動(dòng)時(shí)產(chǎn)生的彎矩最大，并且機(jī)械臂2上關(guān)節(jié)2處單元的彎矩矢量在Z2軸分量最大，機(jī)械臂3上關(guān)節(jié)3處單元的彎矩矢量在Z3軸分量最大，分別設(shè)為M2Zmax及M3Zmax，并且經(jīng)分析M3Zmax＝τ3max、M2Zmax＝τ2max；則機(jī)械臂運(yùn)動(dòng)時(shí)，第二機(jī)械臂(2)上最大應(yīng)力第三機(jī)械臂(3)上的最大應(yīng)力其中，τ2max、τ3max為運(yùn)動(dòng)時(shí)各關(guān)節(jié)驅(qū)動(dòng)電機(jī)施加到機(jī)械臂上的最大轉(zhuǎn)矩，W2Z、W3Z分別表示機(jī)械臂2與機(jī)械臂3的截面相對(duì)于連桿坐標(biāo)系2的Z2軸及連桿坐標(biāo)系3的Z3軸的抗彎截面系數(shù)；經(jīng)計(jì)算可知對(duì)于τ2max、τ3ma，根據(jù)三自由度機(jī)器人機(jī)械部分的動(dòng)力學(xué)方程可知 即關(guān)節(jié)施加到機(jī)械臂上的電磁轉(zhuǎn)矩是關(guān)節(jié)位置、關(guān)節(jié)角速度、角加速度的值以及機(jī)器人的機(jī)械參數(shù)的非線性函數(shù)，而

的值，又取決于各關(guān)節(jié)電機(jī)能提供的最大角速度

及最大角加速度

的值(i＝1，2，3)，因此τ2、τ3是一個(gè)非線性有約束的多元函數(shù)，其最大值τ2max、τ3max的求解可以通過(guò)非線性函數(shù)約束條件下求極值的方法獲得。
使用由上述五個(gè)步驟獲得的強(qiáng)度分析模型得到涉及第二機(jī)械臂(2)及第三機(jī)械臂(3)的綜合強(qiáng)度性能指標(biāo) 其中，[σ]為第二機(jī)械臂(2)及第三機(jī)械臂(3)所用材料的許用彎曲應(yīng)力；σ2max、σ3max分別表示在機(jī)器人運(yùn)動(dòng)過(guò)程中，第二機(jī)械臂(2)及第三機(jī)械臂(3)上的最大應(yīng)力；|σ2max-0.8[σ]|、|σ3max-0.8[σ]|分別表示機(jī)器人運(yùn)動(dòng)過(guò)程中，第二機(jī)械臂(2)及第三機(jī)械臂(3)上的最大應(yīng)力與材料許用彎曲應(yīng)力的0.8倍的接近程度，l1為第一機(jī)械臂的臂長(zhǎng)，b2、h2為第二機(jī)械臂(2)外截面的寬度及高度，b2e、h2e為第二機(jī)械臂(2)內(nèi)腔的寬度及高度，b3、h3為第三機(jī)械臂(3)外截面的寬度及高度，b3e、h3e為第三機(jī)械臂(3)內(nèi)腔的寬度及高度，

分別為第二關(guān)節(jié)、第三關(guān)節(jié)的最大角加速度，

分別為第一關(guān)節(jié)、第二關(guān)節(jié)、第三關(guān)節(jié)的最大角速度，7×107為比例系數(shù)。
最后，通過(guò)通過(guò)以下各步驟建立基于機(jī)電耦合系統(tǒng)動(dòng)力學(xué)模型及逆動(dòng)力學(xué)控制的系統(tǒng)閉環(huán)模型 第一，通過(guò)拉格朗日-歐拉法建立該機(jī)器人機(jī)械負(fù)載部分的動(dòng)力學(xué)方程，其形式為 其中，Di、Dij、Dijk為機(jī)械部分動(dòng)力學(xué)方程的系數(shù)，這些系數(shù)與機(jī)械設(shè)計(jì)參數(shù)及機(jī)械臂運(yùn)動(dòng)位置有關(guān)。τi為施加到機(jī)械臂i的機(jī)械部分的轉(zhuǎn)矩，Iai為機(jī)械臂i傳動(dòng)裝置的轉(zhuǎn)動(dòng)慣量，

θi分別為機(jī)械臂i所對(duì)應(yīng)關(guān)節(jié)的瞬時(shí)角加速度、角速度及角位移，其中(i＝1，2，3)。
在此基礎(chǔ)上，設(shè)計(jì)該機(jī)器人機(jī)械系統(tǒng)與電機(jī)系統(tǒng)不經(jīng)變速箱而直接連接，并將機(jī)械部分動(dòng)力學(xué)模型折算到電機(jī)側(cè)，建立起機(jī)電耦合系統(tǒng)的動(dòng)力學(xué)模型 ；其中，umi為機(jī)械臂i控制電機(jī)的電樞電路電壓；Ki為機(jī)械臂i的機(jī)械部分向電機(jī)部分折算的系數(shù)，Ki＝Rmi/kmi，

為機(jī)械臂i的系統(tǒng)傳動(dòng)裝置總轉(zhuǎn)動(dòng)慣量，Rmi、kmi、kei、Jmi分別為機(jī)械臂i對(duì)應(yīng)控制電機(jī)的電樞電路電阻、轉(zhuǎn)矩系數(shù)和電勢(shì)系數(shù)和電機(jī)軸的轉(zhuǎn)動(dòng)慣量(i＝1，2，3)。
第二，在機(jī)電耦合系統(tǒng)的動(dòng)力學(xué)模型的基礎(chǔ)上，采用具有偏置的PD控制律及逆動(dòng)力學(xué)控制的策略，最終構(gòu)成機(jī)器人控制系統(tǒng)，最終構(gòu)成機(jī)器人閉環(huán)控制系統(tǒng)框圖如圖2所示，其中，Θd＝[θd1，θd2，θd3]T，分別為參考軌跡向量、參考角速度及參考角加速度向量；KD＝diag(kd1，kd2，kd3)、KP＝diag(kp1，kp2，kp3)，分別為控制器微分系數(shù)矩陣與比例系數(shù)矩陣。
第三，該機(jī)器人運(yùn)動(dòng)控制的參考軌線采用關(guān)節(jié)空間中拋物線過(guò)渡的線性插值法產(chǎn)生，并且使用機(jī)器人各關(guān)節(jié)的最大運(yùn)動(dòng)能力進(jìn)行規(guī)劃，以保證任何控制任務(wù)在機(jī)器人設(shè)計(jì)的運(yùn)動(dòng)能力內(nèi)以最短的時(shí)間完成；各關(guān)節(jié)的最大運(yùn)動(dòng)能力與各關(guān)節(jié)驅(qū)動(dòng)電機(jī)有關(guān)，包括各關(guān)節(jié)的最大角加速度

(單位rad/s2)以及各關(guān)節(jié)的最大角速度

(單位rad/s)，在關(guān)節(jié)期望運(yùn)動(dòng)的勻加速運(yùn)動(dòng)階段，各關(guān)節(jié)以

加速運(yùn)動(dòng)，至關(guān)節(jié)角速度達(dá)到

在關(guān)節(jié)期望運(yùn)動(dòng)的勻速運(yùn)動(dòng)階段，各關(guān)節(jié)以

勻速運(yùn)動(dòng)；在關(guān)節(jié)期望運(yùn)動(dòng)的勻減速運(yùn)動(dòng)階段，各關(guān)節(jié)以

減速運(yùn)動(dòng)，至關(guān)節(jié)角速度達(dá)到0；三段期望運(yùn)動(dòng)的結(jié)束時(shí)刻分別設(shè)為tai、tbi、tci，對(duì)于某些控制任務(wù)的期望運(yùn)動(dòng)也可能僅由勻加速與勻減速兩段組成，該兩端期望運(yùn)動(dòng)結(jié)束時(shí)間分別設(shè)為tai、tci。
第四，由于給定參考輸入運(yùn)動(dòng)軌線在tai、tbi、tci時(shí)刻二階導(dǎo)數(shù)不連續(xù)，實(shí)際控制軌線與參考軌線存在誤差；由閉環(huán)控制系統(tǒng)模型可知誤差函數(shù)為該誤差函數(shù)是一個(gè)二階微分方程，為使誤差函數(shù)收斂，應(yīng)通過(guò)控制器參數(shù)調(diào)整保證誤差系統(tǒng)為過(guò)阻尼或臨界阻尼狀態(tài)，對(duì)于每個(gè)關(guān)節(jié)而言，即要求k2di≥4kpi，(i＝1，2，3)。通過(guò)上述控制器參數(shù)下對(duì)閉環(huán)控制系統(tǒng)進(jìn)行仿真可知，該誤差在控制過(guò)程中完全可忽略不計(jì)； 第五，對(duì)于一項(xiàng)搬運(yùn)任務(wù)其控制結(jié)束時(shí)間及所需控制能量的計(jì)算方法為設(shè)在基坐標(biāo)系中搬運(yùn)任務(wù)初始點(diǎn)坐標(biāo)為(x0，y0，z0)，終止點(diǎn)坐標(biāo)為(xf，yf，zf)，根據(jù)該機(jī)械臂逆運(yùn)動(dòng)學(xué)模型，計(jì)算完成該搬運(yùn)任務(wù)各關(guān)節(jié)的初始關(guān)節(jié)角θi0終止關(guān)節(jié)角θif；根據(jù)上述參考軌跡的規(guī)劃方案，生成各關(guān)節(jié)完成該搬運(yùn)任務(wù)對(duì)應(yīng)的參考角度軌線θdi(t)、參考角速度軌線

和參考角加速度軌線

并分別組成參考軌跡向量Θd(t)、參考角速度向量

及參考角加速度向量

根據(jù)具有偏置的PD控制律及逆動(dòng)力學(xué)控制的策略的控制特點(diǎn)，可以認(rèn)為控制結(jié)束時(shí)間即為三個(gè)關(guān)節(jié)參考軌跡結(jié)束時(shí)間，各關(guān)節(jié)控制過(guò)程中實(shí)際的角度、角速度、角加速度軌線即為參考角度、角速度、角加速度軌線；因此，該搬運(yùn)任務(wù)的控制時(shí)間為tf＝tc＝max(tc1，tc2，tc3)，該搬運(yùn)任務(wù)的控制能量為其中τi(t)由機(jī)械臂機(jī)械部分動(dòng)力學(xué)模型及控制任務(wù)對(duì)應(yīng)的參考軌跡計(jì)算， 使用通過(guò)上述五個(gè)步驟獲得的系統(tǒng)閉環(huán)模型得到第一機(jī)械臂(1)、第二機(jī)械臂(2)及第三機(jī)械臂(3)的平均控制能量指標(biāo) 及平均控制時(shí)間指標(biāo) 其中，200是指在給定設(shè)計(jì)要求的工作空間中隨機(jī)選取400個(gè)點(diǎn)作為搬運(yùn)任務(wù)的起止點(diǎn)，由此組成200組搬運(yùn)任務(wù)工作點(diǎn)；n表示第n組搬運(yùn)任務(wù)，mLn表示第n組搬運(yùn)任務(wù)的負(fù)載質(zhì)量，|θ1n|、|θ2n|、|θ3n|分別表示表示完成第n組搬運(yùn)任務(wù)第一關(guān)節(jié)、第二關(guān)節(jié)及第三關(guān)節(jié)的轉(zhuǎn)動(dòng)角度，τ1(t)、τ2(t)、τ3(t)分別表示完成第n組搬運(yùn)任務(wù)第一關(guān)節(jié)、第二關(guān)節(jié)及第三關(guān)節(jié)在t時(shí)刻輸出的電磁轉(zhuǎn)矩，tfn表示完成第n組搬運(yùn)任務(wù)的完成時(shí)間，R1、r1分別為圓筒形的第一機(jī)械臂(1)外半徑及內(nèi)半徑，

為第一關(guān)節(jié)的最大角加速度； 步驟2對(duì)工作空間性能指標(biāo)、綜合強(qiáng)度性能指標(biāo)、平均控制能量指標(biāo)及平均控制時(shí)間指標(biāo)涉及的參數(shù)進(jìn)行選擇性優(yōu)化，并建立多目標(biāo)并行優(yōu)化模型 首先，選擇參數(shù)l2、l3、b2、h2、b3、h3、

作為設(shè)計(jì)變量，對(duì) 工作空間性能指標(biāo) J1＝λ1Rmin-λ2Rmax， 綜合強(qiáng)度性能指標(biāo) J2＝|σ2zmax-0.8[σ]|+|σ3Zmax-0.8[σ]|， 平均控制能量指標(biāo) 及平均控制時(shí)間指標(biāo) 進(jìn)行同時(shí)優(yōu)化，得到多目標(biāo)優(yōu)化設(shè)計(jì)任務(wù) 其中，x1是由設(shè)計(jì)變量l2、l3組成的向量，稱(chēng)之為臂長(zhǎng)設(shè)計(jì)向量，其中，

的下標(biāo)1表示設(shè)計(jì)向量x1，上標(biāo)1表示設(shè)計(jì)向量x1的第一分量，

的下標(biāo)1表示設(shè)計(jì)向量x1，上標(biāo)2表示設(shè)計(jì)向量x1的第二分量；x2是由設(shè)計(jì)變量b2、h2、b3、h3組成的向量，稱(chēng)之為臂的厚度設(shè)計(jì)向量，其中，

的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)1表示設(shè)計(jì)向量x2的第一分量，

的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)2表示設(shè)計(jì)向量x2的第二分量，

的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)3表示設(shè)計(jì)向量x2的第三分量，

的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)4表示設(shè)計(jì)向量x2的第四分量；x3是由設(shè)計(jì)變量組成的向量，稱(chēng)之為關(guān)節(jié)的運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)1表示設(shè)計(jì)向量x3的第一分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)2表示設(shè)計(jì)向量x3的第二分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)3表示設(shè)計(jì)向量x3的第三分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)4表示設(shè)計(jì)向量x3的第四分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)5表示設(shè)計(jì)向量x3的第五分量，

的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)6表示設(shè)計(jì)向量x3的第六分量；φ1為第一約束條件向量，φ1＝[(l2—l3)—dmin，dmax—(l2+l3)，l3—l2，—l2，—l3]T，這里，dmin＝0.2，dmax＝1.5，分別代表對(duì)所設(shè)計(jì)的機(jī)械臂工作空間最小半徑與最大半徑的設(shè)計(jì)要求，其值根據(jù)具體的設(shè)計(jì)需要進(jìn)行調(diào)整；φ2為第二約束條件向量，φ2＝[h2e-h2，b2e-b2，h3e-h3，b3e-b3]T；φ3為第三約束條件向量 其次，將約束條件與工作空間性能指標(biāo)J1、綜合強(qiáng)度性能指標(biāo)J2、平均控制能量指標(biāo)J3及平均控制時(shí)間指標(biāo)J4進(jìn)行合并轉(zhuǎn)化，得到廣義工作空間性能指標(biāo)Z1，廣義綜合強(qiáng)度性能指標(biāo)Z2，廣義平均控制能量指標(biāo)Z3及廣義平均控制時(shí)間指標(biāo)Z4 其中，

分別是工作空間性能指標(biāo)J1、綜合強(qiáng)度性能指標(biāo)J2、平均控制能量指標(biāo)J3及平均控制時(shí)間指標(biāo)J4的期望值，

分別表示第一約束條件向量的第m個(gè)元素、第二約束條件向量的第m個(gè)元素、第三約束條件向量的第m個(gè)元素；σ1為第一罰系數(shù)，σ1＝1000；σ2為第二罰系數(shù)，σ2＝1000；σ3為第三罰系數(shù)，σ3＝1000； 步驟3用控制方法獲得多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù) 建立第一控制律 其中，v1，i為第i次迭代時(shí)臂長(zhǎng)設(shè)計(jì)向量x1的調(diào)整量，

的第一下標(biāo)1和上標(biāo)1表示該調(diào)整量是對(duì)設(shè)計(jì)向量x1中的第一設(shè)計(jì)變量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)1和上標(biāo)2表示該調(diào)整量是對(duì)設(shè)計(jì)向量x1中的第二設(shè)計(jì)變量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)； 對(duì)第一控制律產(chǎn)生的調(diào)整量v1，i的調(diào)整幅度進(jìn)行修正 如果 如果 其中，

表示設(shè)計(jì)向量x1的第一設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x1的第二設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值； 用修正后的調(diào)整值v1，i調(diào)整臂長(zhǎng)設(shè)計(jì)向量x1，得到第i次迭代后設(shè)計(jì)向量x1的值x1，i＝x1，i-1+v1，i；e1，i-1為廣義工作空間性能指標(biāo)Z1在第i—1次迭代后的值Z1，i-1與目標(biāo)值0的誤差，e1，i-1＝0—Z1，i-1； e2，i-1為廣義綜合強(qiáng)度性能指標(biāo)Z2在第i—1次迭代后的值Z2，i-1與目標(biāo)值0的誤差，e2，i-1＝0—Z2，i-1； e3，i-1為廣義平均控制能量指標(biāo)Z3在第i—1次迭代后的值Z3，i-1與目標(biāo)值0的誤差，e3，i-1＝0—Z3，i-1； e4，i-1為廣義平均控制時(shí)間指標(biāo)Z4在第i—1次迭代后的值Z4，i-1與目標(biāo)值0的誤差，e4，i-1＝0—Z4，i-1；

為誤差值e1，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

的上標(biāo)1表示廣義工作空間性能指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義工作空間性能指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e2，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

的上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義綜合強(qiáng)度性能指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e3，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)3表示廣義平均控制能量指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制能量性能指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e4，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制時(shí)間指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e1，i-1在控制律1中的比例系數(shù)，

上標(biāo)1表示廣義工作空間性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令

為誤差值e2，i-1在控制律1中的比例系數(shù)，

上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令

為誤差值e3，i-1在控制律1中的比例系數(shù)，

上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令

為誤差值e4，i-1在控制律1中的比例系數(shù)，

上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令 建立第二控制律 其中，v2，i為第i次迭代時(shí)臂厚設(shè)計(jì)向量x2的調(diào)整量，

的第一下標(biāo)2和上標(biāo)1表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第一設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)2和上標(biāo)2表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第二設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)2和上標(biāo)3表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第三設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)2和上標(biāo)4表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第四設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)； 對(duì)第二控制律產(chǎn)生的調(diào)整量v2，i的調(diào)整幅度進(jìn)行修正 如果 如果 其中，

表示設(shè)計(jì)向量x2的第一設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x2的第二設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x2的第三設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x2的第四設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值； 用修正后的調(diào)整值v2，i調(diào)整臂厚設(shè)計(jì)向量，得到第i次迭代后設(shè)計(jì)向量x2的值x3，i＝x2，i-1+v2，i；

為誤差值e2，i-1相對(duì)于設(shè)計(jì)向量值x2，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

的上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，第一下標(biāo)2表示臂厚設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義綜合強(qiáng)度性能指標(biāo)的誤差值及臂厚設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e3，i-1相對(duì)于設(shè)計(jì)向量值x2，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，第一下標(biāo)2表示臂厚設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制能量指標(biāo)的誤差值及臂厚設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差e2，i-1在控制律2中的比例系數(shù)，

上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，下標(biāo)2表示控制律2，并且令

為誤差e3，i-1在控制律2中的比例系數(shù)，

上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，下標(biāo)2表示控制律1，并且令 建立第三控制律 其中，v3，i為第i次迭代時(shí)關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的調(diào)整量，

的第一下標(biāo)3和上標(biāo)1表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第一設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)3和上標(biāo)2表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第二個(gè)設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)3和上標(biāo)3表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第三設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，

的第一下標(biāo)3和上標(biāo)4表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第四設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)；

的第一下標(biāo)3和上標(biāo)5表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第五設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)；

的第一下標(biāo)3和上標(biāo)6表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第六設(shè)計(jì)分量

的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)； 對(duì)第三控制律產(chǎn)生的調(diào)整量v3，i的調(diào)整幅度進(jìn)行修正 如果 如果 其中，

表示設(shè)計(jì)向量x3的第一設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第二設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第三設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第四設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第五設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值，

表示設(shè)計(jì)向量x3的第六設(shè)計(jì)分量

第i—1次迭代后的設(shè)計(jì)值； 用修正后的調(diào)整量v3，i調(diào)整關(guān)節(jié)的運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3，計(jì)算第i次迭代后設(shè)計(jì)向量x3的值x3，i＝x3，i-1+v3，i；

為誤差值e2，i-1相對(duì)于設(shè)計(jì)向量值x3，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

的上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，第一下標(biāo)3表示設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義綜合強(qiáng)度性能指標(biāo)的誤差值及運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e3，i-1相對(duì)于設(shè)計(jì)向量值x3，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，第一下標(biāo)3表示運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制能量性能指標(biāo)的誤差值及運(yùn)動(dòng)學(xué)能力向量的值為第i—1次迭代后的值；

為誤差值e4，i-1相對(duì)于設(shè)計(jì)向量值x3，i-1的偏導(dǎo)數(shù)的符號(hào)向量，

的上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，第一下標(biāo)3表示設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算

時(shí)廣義平均控制時(shí)間性能指標(biāo)的誤差值及運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量的值為第i—1次迭代后的值；

為誤差值e2，i-1在控制律3中的比例系數(shù)，

上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，下標(biāo)3表示控制律3，并且令

為誤差值e3，i-1在控制律3中的比例系數(shù)，

上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，下標(biāo)3表示控制律3，并且令

為誤差值e4，i-1在控制律4中的比例系數(shù)，

上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，下標(biāo)4表示控制律4，并且令 利用第一控制律、第二控制律、第三控制律對(duì)臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3進(jìn)行第一次優(yōu)化設(shè)計(jì) 為臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3賦初始設(shè)計(jì)值，得到向量x1，0、向量x2，0、向量x3，0； 為各性能指標(biāo)期望值

賦第一次多目標(biāo)優(yōu)化設(shè)計(jì)的參考值


得到對(duì)于

其第一下標(biāo)1表示工作空間性能表，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)，對(duì)于

其第一下標(biāo)2表示綜合強(qiáng)度性能指標(biāo)，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)，對(duì)于

其第一下標(biāo)3表示平均控制能量指標(biāo)，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)，對(duì)于

其第一下標(biāo)4表示平均控制時(shí)間指標(biāo)，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)； 由第一次多目標(biāo)優(yōu)化設(shè)計(jì)的參考值

及x1，0、x2，0、x3，0計(jì)算得到各廣義性能指標(biāo)的初始值Z1，0、Z2，0、Z3，0、Z4，0；如果Z1，0、Z2，0、Z3，0、Z4，0不全部為零，則進(jìn)入步驟3.1；如果Z1，0、Z2，0、Z3，0、Z4，0全部為零，則設(shè)計(jì)向量x1、x2、x3的初始值x1，0、x2，0、x3，0即為多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的值； 步驟3.1對(duì)設(shè)計(jì)變量組成的向量x1、x2、x3進(jìn)行第一次迭代，迭代次數(shù)i＝1 首先，由第一控制律及對(duì)第一控制律產(chǎn)生的調(diào)整量v1，1幅度修正方法 如果 如果 生成對(duì)向量x1的第一次迭代的調(diào)整值v1，1，再用調(diào)整值v1，1調(diào)整向量x1，得到向量x1第一次迭代后的值x1，1＝x1，0+v1，1；這里，e1，0為廣義工作空間性能指標(biāo)在初始時(shí)刻的值Z1，0與目標(biāo)值0的誤差，e1，0＝0—Z1，0；e2，0為廣義綜合強(qiáng)度性能指標(biāo)在初始時(shí)刻的值Z2，0與目標(biāo)值0的誤差，e2，0＝0—Z2，0；e3，0為廣義平均控制能量指標(biāo)在初始時(shí)刻的值Z3，0與目標(biāo)值0的誤差，e3，0＝0—Z3，0；e4，0為廣義平均控制時(shí)間指標(biāo)在初始時(shí)刻的值Z4，0與目標(biāo)值0的誤差，e4，0＝0—Z4，0；

為誤差值e1，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e2，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e4，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 其次，由第二控制律及對(duì)第二控制律產(chǎn)生的調(diào)整量v2，1的幅度修正方法 如果 如果 生成對(duì)臂厚設(shè)計(jì)向量x2的第一次迭代的調(diào)整值v2，1，用調(diào)整值v2，1調(diào)整臂厚設(shè)計(jì)向量x2，得到向量x2的第一次迭代后的值x2，1＝x2，0+v2，1；這里，

為誤差值e2，0相對(duì)于設(shè)計(jì)向量值x2，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，0相對(duì)于設(shè)計(jì)向量值x2，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 再次，由第三控制律及對(duì)第三控制律產(chǎn)生的調(diào)整量v3，1的幅度修正方法 如果 如果 生成對(duì)關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的第一次調(diào)整值v3，1，用調(diào)整值v3，1調(diào)整關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3，得到設(shè)計(jì)向量x3的第一次迭代后的值x3，1＝x3，0+v3，1；這里，

為誤差值e2，0相對(duì)于x3，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，0相對(duì)于設(shè)計(jì)向量值x3，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e4，0相對(duì)于設(shè)計(jì)向量值x3，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 最后，在得到設(shè)計(jì)向量x1、x2、x3的第一次迭代后的向量值x1，1、x2，1、x3，1之后，計(jì)算第一次調(diào)整后各廣義性能的值Z1，1、Z2，1、Z3，1、Z4，1，如果Z1，1、Z2，1、Z3，1、Z4，1不全部為零，則進(jìn)入步驟3.2；如果Z1，1、Z2，1、Z3，1、Z4，1全部為零，則所得到的向量x1、x2、x3的第一次迭代的值x1，1、x2，1、x3，1為多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)； 步驟3.2對(duì)設(shè)計(jì)變量組成的向量x1、x2、x3進(jìn)行第二次迭代，迭代次數(shù)i＝2 首先，由第一控制律及對(duì)第一控制律產(chǎn)生的調(diào)整量v1，2幅度修正方法 如果 如果 生成對(duì)向量x1的第二次迭代的調(diào)整值v1，2，再用調(diào)整值v1，2調(diào)整向量x2，得到第二次迭代后設(shè)計(jì)向量x1的值x1，2＝x1，1+v1，2；這里，e1，1為廣義工作空間性能指標(biāo)在第一次迭代后的值Z1，1與目標(biāo)值0的誤差，e1，1＝0—Z1，1；e2，1為廣義綜合強(qiáng)度性能指標(biāo)在第一次迭代后的值Z2，1與目標(biāo)值0的誤差，e2，1＝0—Z2，1；e3，1為廣義平均控制能量性能指標(biāo)在第一次迭代后的值Z3，1與目標(biāo)值0的誤差，e3，1＝0—Z3，1；e4，1為廣義平均控制能量性能指標(biāo)在第一次迭代后的值Z4，1與目標(biāo)值0的誤差，e4，1＝0—Z4，1；

為誤差值e1，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e2，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e4，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 其次，由第二控制律及對(duì)第二控制律產(chǎn)生的調(diào)整量v2，2的幅度修正方法 如果 如果 生成設(shè)計(jì)向量x2進(jìn)行第二次迭代的調(diào)整值再用調(diào)整值v2，2調(diào)整設(shè)計(jì)向量x2的值，得到第二次迭代后設(shè)計(jì)向量x2的值x2，2＝x2，1+v2，2；這里，

為誤差值e2，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，1相對(duì)于設(shè)計(jì)向量值x2，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 再次，由第三控制律及對(duì)第三控制律產(chǎn)生的調(diào)整量v3，2的幅度修正方法 如果 如果 生成設(shè)計(jì)向量x3的第二次迭代的調(diào)整值，再用調(diào)整值v3，2調(diào)整設(shè)計(jì)向量x3的值，得到第二次迭代后向量x3的值x3，2＝x3，1+v3，2；這里，

為e2，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e3，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，

為誤差值e4，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量， 最后，用得到的設(shè)計(jì)向量x1、x2、x3第二次迭代后的值x1，2、x2，2、x3，2，計(jì)算第二次迭代后各廣義性能的值Z1，2、Z2，2、Z3，2、Z4，2，如果Z1，2、Z2，2、Z3，2、Z4，2不全部為零，則進(jìn)入步驟3.3；如果Z1，2、Z2，2、Z3，2、Z4，2全部為零，則所得到的向量x1、x2、x3的第二次迭代的值x1，2、x2，2、x3，2即為多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的值； 步驟3.3依此類(lèi)推，通過(guò)第一控制律及對(duì)第一控制律產(chǎn)生的調(diào)整量幅度的修正方法，生成設(shè)計(jì)向量x1進(jìn)行第j次迭代的調(diào)整值v1，j；通過(guò)第二控制律及對(duì)第二控制律產(chǎn)生的調(diào)整量幅度的修正方法，生成設(shè)計(jì)向量x2進(jìn)行第j次迭代的調(diào)整值v2，j；通過(guò)第三控制律及對(duì)第三控制律產(chǎn)生的調(diào)整量幅度的修正方法，生成設(shè)計(jì)向量x3進(jìn)行第j次迭代的調(diào)整值v3，j；重復(fù)上述迭代，如果在100次迭代內(nèi)通過(guò)調(diào)整臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的值可以使廣義工作空間性能指標(biāo)Z1、廣義綜合強(qiáng)度性能指標(biāo)Z2、廣義平均控制能量指標(biāo)Z3、廣義平均控制時(shí)間指標(biāo)Z4的值同時(shí)為零，則獲得最終獲得使各性能同時(shí)得到優(yōu)化的臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的設(shè)計(jì)值；如果在100次迭代內(nèi)無(wú)法使得廣義工作空間性能指標(biāo)Z1、廣義綜合強(qiáng)度性能指標(biāo)Z2、廣義平均控制能量指標(biāo)Z3、廣義平均控制時(shí)間指標(biāo)Z4的值同時(shí)為零，則進(jìn)入步驟3.4，直到各廣義性能在100次迭代內(nèi)使得廣義性能指標(biāo)Z1、Z2、Z3、Z4的值同時(shí)為零，獲得最終獲得使各性能同時(shí)得到優(yōu)化的臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的最終設(shè)計(jì)值； 步驟3.4對(duì)各性能指標(biāo)期望值

的期望值進(jìn)行第n—1次調(diào)整后進(jìn)行第n次優(yōu)化設(shè)計(jì)，令n為優(yōu)化設(shè)計(jì)的次數(shù)，對(duì)設(shè)計(jì)向量x1、x2、x3進(jìn)行第n次優(yōu)化設(shè)計(jì)，重復(fù)步驟3.1～步驟3.3。
實(shí)施例2 對(duì)三自由度搬運(yùn)機(jī)器人的基本設(shè)計(jì)要求為該三自由度工業(yè)機(jī)器人的工作空間為以(0，0，1)為球心，最大半徑Rmax＝1.5，最小半徑Rmin＝0.2的兩球之間的部分(單位m)。要求搬運(yùn)的最大負(fù)載質(zhì)量為25kg。在此基礎(chǔ)上，要求工作空間最大化，強(qiáng)度滿足材料要求，機(jī)械臂控制過(guò)程能量、時(shí)間性能最優(yōu)。
對(duì)于本設(shè)計(jì)中的三自由度搬運(yùn)機(jī)器人而言，通過(guò)第三章的分析，確定了表征機(jī)械設(shè)計(jì)參數(shù)及反應(yīng)電機(jī)性能參數(shù)的12個(gè)參數(shù)作為整個(gè)設(shè)計(jì)過(guò)程的設(shè)計(jì)變量。同時(shí)，對(duì)于機(jī)械臂1的機(jī)械參數(shù)l1、R1、r1，以及機(jī)械臂2、3的內(nèi)腔參數(shù)h2e、b2e、h3e、b3e由于其對(duì)性能影響不大，或者由于可以作為預(yù)先設(shè)計(jì)的參數(shù)在設(shè)計(jì)前確定所以這些參數(shù)沒(méi)有作為整個(gè)設(shè)計(jì)的設(shè)計(jì)參數(shù)，作為預(yù)先設(shè)計(jì)值給定。
對(duì)于本設(shè)計(jì)任務(wù)，提給定預(yù)先設(shè)計(jì)參數(shù)的值分別為l1＝1、R1＝0.075、r1＝0.05、h2e＝0.08、b2e＝0.08、h3e＝0.08、b3e＝0.08(單位m)。
下面開(kāi)始具體的設(shè)計(jì)。
首先，初始化各設(shè)計(jì)變量。
x1＝
T，x2＝
T，x3＝[5，5，5，3，3，3]T。
計(jì)算初始化設(shè)計(jì)變量下機(jī)械臂各性能為 J1＝—1.2，J2＝1.3879，J3＝1.6411，J4＝0.4393。
結(jié)合機(jī)械臂初始性能，給定各性能最終優(yōu)化的次最優(yōu)指標(biāo) 經(jīng)過(guò)24次疊代，各性能都達(dá)到各性能可接受的性能值。在迭代過(guò)程中，廣義性能指標(biāo)Z1、Z2、Z3、Z4的值隨迭代次數(shù)變化的變化圖分別由圖4、圖5、圖6、圖7所示。
x1＝
T，x2＝
T，x3＝[8.26，7.87，8.48，4.99，4.84，4.28]T 最終性能值為 J1＝—1.346，J2＝0.642，J3＝1.4736，J4＝0.3494。
實(shí)施例2，各設(shè)計(jì)變量的變化以及性能指標(biāo)的變化可通過(guò)表1及表2所示。
表1 實(shí)施例2中設(shè)計(jì)變量初始值及最終設(shè)計(jì)值 表2 實(shí)施例2中可接受性能值及性能變化
權(quán)利要求
1.一種三自由度搬運(yùn)工業(yè)機(jī)器人多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的獲取方法，所述的三自由度搬運(yùn)工業(yè)機(jī)器人包括第一機(jī)械臂(1)、第二機(jī)械臂(2)及第三機(jī)械臂(3)，第二機(jī)械臂(2)的兩端分別與第一機(jī)械臂(1)的一端、第三機(jī)械臂(3)的一端轉(zhuǎn)動(dòng)連接，其特征在于多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的獲取方法含有以下步驟
步驟1 建立機(jī)械臂運(yùn)動(dòng)學(xué)模型、強(qiáng)度分析模型、基于機(jī)電耦合系統(tǒng)動(dòng)力學(xué)模型及逆動(dòng)力學(xué)控制的系統(tǒng)閉環(huán)模型，并使用機(jī)械臂運(yùn)動(dòng)學(xué)模型獲得第一機(jī)械臂(1)、第二機(jī)械臂(2)及第三機(jī)械臂(3)的工作空間性能指標(biāo)
J1＝λ1Rmin-λ2Rmax＝f1(l2，l3)，
其中，Rmin為工作空間最小半徑，Rmax為工作空間最大半徑，λ1、λ2分別為最小半徑與最大半徑的權(quán)系數(shù)，l2為第二機(jī)械臂的臂長(zhǎng)，l3為第三機(jī)械臂的臂長(zhǎng)；
使用強(qiáng)度分析模型獲得涉及第二機(jī)械臂(2)及第三機(jī)械臂(3)的綜合強(qiáng)度性能指標(biāo)
其中，[σ]為第二機(jī)械臂(2)及第三機(jī)械臂(3)所用材料的許用彎曲應(yīng)力；σ2max、σ3max分別表示在機(jī)器人運(yùn)動(dòng)過(guò)程中，第二機(jī)械臂(2)及第三機(jī)械臂(3)上的最大應(yīng)力；|σ2max-0.8[σ]|、|σ3max-0.8[σ]|分別表示機(jī)器人運(yùn)動(dòng)過(guò)程中，第二機(jī)械臂(2)及第三機(jī)械臂(3)上的最大應(yīng)力與材料許用彎曲應(yīng)力的0.8倍的接近程度，l1為第一機(jī)械臂的臂長(zhǎng)，b2、h2為第二機(jī)械臂(2)外截面的寬度及高度，b2e、h2e為第二機(jī)械臂(2)內(nèi)腔的寬度及高度，b3、h3為第三機(jī)械臂(3)外截面的寬度及高度，b3e、h3e為第三機(jī)械臂(3)內(nèi)腔的寬度及高度，
、
分別為第二關(guān)節(jié)、第三關(guān)節(jié)的最大角加速度，
、
、
分別為第一關(guān)節(jié)、第二關(guān)節(jié)、第三關(guān)節(jié)的最大角速度，7×107為比例系數(shù)；
使用系統(tǒng)閉環(huán)模型獲得第一機(jī)械臂(1)、第二機(jī)械臂(2)及第三機(jī)械臂(3)的平均控制能量指標(biāo)
及平均控制時(shí)間指標(biāo)
其中，200是指在給定設(shè)計(jì)要求的工作空間中隨機(jī)選取400個(gè)點(diǎn)作為搬運(yùn)任務(wù)的起止點(diǎn)，由此組成200組搬運(yùn)任務(wù)工作點(diǎn)；n表示第n組搬運(yùn)任務(wù)，mLn表示第n組搬運(yùn)任務(wù)的負(fù)載質(zhì)量，|θ1n|、|θ2n|、|θ3n|分別表示表示完成第n組搬運(yùn)任務(wù)第一關(guān)節(jié)、第二關(guān)節(jié)及第三關(guān)節(jié)的轉(zhuǎn)動(dòng)角度，τ1(t)、τ2(t)、τ3(t)分別表示完成第n組搬運(yùn)任務(wù)第一關(guān)節(jié)、第二關(guān)節(jié)及第三關(guān)節(jié)在t時(shí)刻輸出的電磁轉(zhuǎn)矩，tfn表示完成第n組搬運(yùn)任務(wù)的完成時(shí)間，R1、r1分別為圓筒形的第一機(jī)械臂(1)外半徑及內(nèi)半徑，
為第一關(guān)節(jié)的最大角加速度；
步驟2 對(duì)工作空間性能指標(biāo)、綜合強(qiáng)度性能指標(biāo)、平均控制能量指標(biāo)及平均控制時(shí)間指標(biāo)涉及的參數(shù)進(jìn)行選擇性優(yōu)化，并建立多目標(biāo)并行優(yōu)化模型首先，選擇參數(shù)l2、l3、b2、h2、b3、h3、
、
、
、
、
、
作為設(shè)計(jì)變量，對(duì)
工作空間性能指標(biāo)
J1＝λ1Rmin-λ2Rmax，
綜合強(qiáng)度性能指標(biāo)
J2＝|σ2Zmax-0.8[σ]|+|σ3zmax-0.8[σ]|，
平均控制能量指標(biāo)
及平均控制時(shí)間指標(biāo)
進(jìn)行同時(shí)優(yōu)化，得到多目標(biāo)優(yōu)化設(shè)計(jì)任務(wù)
其中，x1是由設(shè)計(jì)變量l2、l3組成的向量，稱(chēng)之為臂長(zhǎng)設(shè)計(jì)向量，其中，
的下標(biāo)1表示設(shè)計(jì)向量x1，上標(biāo)1表示設(shè)計(jì)向量x1的第一分量，
的下標(biāo)1表示設(shè)計(jì)向量x1，上標(biāo)2表示設(shè)計(jì)向量x1的第二分量；x2是由設(shè)計(jì)變量b2、h2、b3、h3組成的向量，稱(chēng)之為臂的厚度設(shè)計(jì)向量，其中，
的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)1表示設(shè)計(jì)向量x2的第一分量，
的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)2表示設(shè)計(jì)向量x2的第二分量，
的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)3表示設(shè)計(jì)向量x2的第三分量，
的下標(biāo)2表示設(shè)計(jì)向量x2，上標(biāo)4表示設(shè)計(jì)向量x2的第四分量；x3是由設(shè)計(jì)變量
、
、
、
、
、
組成的向量，稱(chēng)之為關(guān)節(jié)的運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量，
的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)1表示設(shè)計(jì)向量x3的第一分量，
的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)2表示設(shè)計(jì)向量x3的第二分量，
的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)3表示設(shè)計(jì)向量x3的第三分量，
的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)4表示設(shè)計(jì)向量x3的第四分量，
的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)5表示設(shè)計(jì)向量x3的第五分量，
的下標(biāo)3表示設(shè)計(jì)向量x3，上標(biāo)6表示設(shè)計(jì)向量x3的第六分量；φ1為第一約束條件向量，φ1＝[(l2—l3)—dmin，dmax—(l2+l3)，l3—l2，—l2，—l3]T，這里，dmin＝0.2，dmax＝1.5，分別代表對(duì)所設(shè)計(jì)的機(jī)械臂工作空間最小半徑與最大半徑的設(shè)計(jì)要求，其值根據(jù)具體的設(shè)計(jì)需要進(jìn)行調(diào)整；φ2為第二約束條件向量，φ2＝[h2e-h2，b2e-b2，h3e-h3，b3e-b3]T；φ3為第三約束條件向量
其次，將約束條件與工作空間性能指標(biāo)J1、綜合強(qiáng)度性能指標(biāo)J2、平均控制能量指標(biāo)J3及平均控制時(shí)間指標(biāo)J4進(jìn)行合并轉(zhuǎn)化，得到廣義工作空間性能指標(biāo)Z1，廣義綜合強(qiáng)度性能指標(biāo)Z2，廣義平均控制能量指標(biāo)Z3及廣義平均控制時(shí)間指標(biāo)Z4
其中，
分別是工作空間性能指標(biāo)J1、綜合強(qiáng)度性能指標(biāo)J2、平均控制能量指標(biāo)J3及平均控制時(shí)間指標(biāo)J4的期望值，
分別表示第一約束條件向量的第m個(gè)元素、第二約束條件向量的第m個(gè)元素、第三約束條件向量的第m個(gè)元素；σ1為第一罰系數(shù)，σ1＝1000；σ2為第二罰系數(shù)，σ2＝1000；σ3為第三罰系數(shù)，σ3＝1000；
步驟3 用控制方法獲得多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)
建立第一控制律
其中，v1，i為第i次迭代時(shí)臂長(zhǎng)設(shè)計(jì)向量x1的調(diào)整量，
的第一下標(biāo)1和上標(biāo)1表示該調(diào)整量是對(duì)設(shè)計(jì)向量x1中的第一設(shè)計(jì)變量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，
的第一下標(biāo)1和上標(biāo)2表示該調(diào)整量是對(duì)設(shè)計(jì)向量x1中的第二設(shè)計(jì)變量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)；
對(duì)第一控制律產(chǎn)生的調(diào)整量v1，i的調(diào)整幅度進(jìn)行修正
如果
如果
其中，
表示設(shè)計(jì)向量x1的第一設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值，
表示設(shè)計(jì)向量x1的第二設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值；
用修正后的調(diào)整值v1，i調(diào)整臂長(zhǎng)設(shè)計(jì)向量x1，得到第i次迭代后設(shè)計(jì)向量x1的值x1，i＝x1，i-1+v1，i；e1，i-1為廣義工作空間性能指標(biāo)Z1在第i—1次迭代后的值Z1，i-1與目標(biāo)值0的誤差，e1，i-1＝0—Z1，i-1；
e2，i-1為廣義綜合強(qiáng)度性能指標(biāo)Z2在第i—1次迭代后的值Z2，i-1與目標(biāo)值0的誤差，e2，i-1＝0—Z2，i-1；
e3，i-1為廣義平均控制能量指標(biāo)Z3在第i—1次迭代后的值Z3，i-1與目標(biāo)值0的誤差，e3，i-1＝0—Z3，i-1；
e4，i-1為廣義平均控制時(shí)間指標(biāo)Z4在第i—1次迭代后的值Z4，i-1與目標(biāo)值0的誤差，e4，i-1＝0—Z4，i-1；
為誤差值e1，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
的上標(biāo)1表示廣義工作空間性能指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算
時(shí)廣義工作空間性能指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；
為誤差值e2，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
的上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算
時(shí)廣義綜合強(qiáng)度性能指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；
為誤差值e3，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的偏導(dǎo)數(shù)的符號(hào)向量，
的上標(biāo)3表示廣義平均控制能量指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算
時(shí)廣義平均控制能量性能指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；
為誤差值e4，i-1相對(duì)于設(shè)計(jì)向量值x1，i-1的偏導(dǎo)數(shù)的符號(hào)向量，
的上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，第一下標(biāo)1表示臂長(zhǎng)設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算
時(shí)廣義平均控制時(shí)間指標(biāo)的誤差值及臂長(zhǎng)設(shè)計(jì)向量的值為第i—1次迭代后的值；
為誤差值e1，i-1在控制律1中的比例系數(shù)，
上標(biāo)1表示廣義工作空間性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令
為誤差值e2，i-1在控制律1中的比例系數(shù)，
上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令
為誤差值e3，i-1在控制律1中的比例系數(shù)，
上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令
為誤差值e4，i-1在控制律1中的比例系數(shù)，
上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，下標(biāo)1表示控制律1，并且令
建立第二控制律
其中，v2，i為第i次迭代時(shí)臂厚設(shè)計(jì)向量x2的調(diào)整量，
的第一下標(biāo)2和上標(biāo)1表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第一設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，
的第一下標(biāo)2和上標(biāo)2表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第二設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，
的第一下標(biāo)2和上標(biāo)3表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第三設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，
的第一下標(biāo)2和上標(biāo)4表示該調(diào)整量是對(duì)設(shè)計(jì)向量x2中的第四設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)；
對(duì)第二控制律產(chǎn)生的調(diào)整量v2，i的調(diào)整幅度進(jìn)行修正
如果
如果
其中，
表示設(shè)計(jì)向量x2的第一設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值，
表示設(shè)計(jì)向量x2的第二設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值，
表示設(shè)計(jì)向量x2的第三設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值，
表示設(shè)計(jì)向量x2的第四設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值；
用修正后的調(diào)整值v2，i調(diào)整臂厚設(shè)計(jì)向量，得到第i次迭代后設(shè)計(jì)向量x2的值x2，i＝x2，i-1+v2，i；
為誤差值e2，i-1相對(duì)于設(shè)計(jì)向量值x2，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
的上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，第一下標(biāo)2表示臂厚設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算
時(shí)廣義綜合強(qiáng)度性能指標(biāo)的誤差值及臂厚設(shè)計(jì)向量的值為第i—1次迭代后的值；
為誤差值e3，i-1相對(duì)于設(shè)計(jì)向量值x2，i-1的偏導(dǎo)數(shù)的符號(hào)向量，
的上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，第一下標(biāo)2表示臂厚設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算
時(shí)廣義平均控制能量指標(biāo)的誤差值及臂厚設(shè)計(jì)向量的值為第i—1次迭代后的值；
為誤差e2，i-1在控制律2中的比例系數(shù)，
上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，下標(biāo)2表示控制律2，并且令
為誤差e3，i-1在控制律2中的比例系數(shù)，
上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，下標(biāo)2表示控制律1，并且令
建立第三控制律
其中，v3，i為第i次迭代時(shí)關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的調(diào)整量，
的第一下標(biāo)3和上標(biāo)1表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第一設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，
的第一下標(biāo)3和上標(biāo)2表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第二個(gè)設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，
的第一下標(biāo)3和上標(biāo)3表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第三設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)，
的第一下標(biāo)3和上標(biāo)4表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第四設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)；
的第一下標(biāo)3和上標(biāo)5表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第五設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)；
的第一下標(biāo)3和上標(biāo)6表示該調(diào)整量是對(duì)設(shè)計(jì)向量x3中的第六設(shè)計(jì)分量
的調(diào)整量，第二下標(biāo)i表示迭代次數(shù)；
對(duì)第三控制律產(chǎn)生的調(diào)整量v3，i的調(diào)整幅度進(jìn)行修正
如果
如果
其中，
表示設(shè)計(jì)向量x3的第一設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值，
表示設(shè)計(jì)向量x3的第二設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值，
表示設(shè)計(jì)向量x3的第三設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值，
表示設(shè)計(jì)向量x3的第四設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值，
表示設(shè)計(jì)向量x3的第五設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值，
表示設(shè)計(jì)向量x3的第六設(shè)計(jì)分量
第i—1次迭代后的設(shè)計(jì)值；
用修正后的調(diào)整量v3，i調(diào)整關(guān)節(jié)的運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3，計(jì)算第i次迭代后設(shè)計(jì)向量x3的值x3，i＝x3，i-1+v3，i；
為誤差值e2，i-1相對(duì)于設(shè)計(jì)向量值x3，i-1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
的上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，第一下標(biāo)3表示設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算
時(shí)廣義綜合強(qiáng)度性能指標(biāo)的誤差值及運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量的值為第i—1次迭代后的值；
為誤差值e3，i-1相對(duì)于設(shè)計(jì)向量值x3，i-1的偏導(dǎo)數(shù)的符號(hào)向量，
的上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，第一下標(biāo)3表示運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算
時(shí)廣義平均控制能量性能指標(biāo)的誤差值及運(yùn)動(dòng)學(xué)能力向量的值為第i—1次迭代后的值；
為誤差值e4，i-1相對(duì)于設(shè)計(jì)向量值x3，i-1的偏導(dǎo)數(shù)的符號(hào)向量，
的上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，第一下標(biāo)3表示設(shè)計(jì)向量，第二下標(biāo)i—1表示在計(jì)算
時(shí)廣義平均控制時(shí)間性能指標(biāo)的誤差值及運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量的值為第i—1次迭代后的值；
為誤差值e2，i-1在控制律3中的比例系數(shù)，
上標(biāo)2表示廣義綜合強(qiáng)度性能指標(biāo)的誤差，下標(biāo)3表示控制律3，并且令
為誤差值e3，i-1在控制律3中的比例系數(shù)，
上標(biāo)3表示廣義平均控制能量性能指標(biāo)的誤差，下標(biāo)3表示控制律3，并且令
為誤差值e4，i-1在控制律4中的比例系數(shù)，
上標(biāo)4表示廣義平均控制時(shí)間性能指標(biāo)的誤差，下標(biāo)4表示控制律4，并且令
利用第一控制律、第二控制律、第三控制律對(duì)臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3進(jìn)行第一次優(yōu)化設(shè)計(jì)
為臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3賦初始設(shè)計(jì)值，得到向量x1，0、向量x2，0、向量x3，0；
為各性能指標(biāo)期望值
賦第一次多目標(biāo)優(yōu)化設(shè)計(jì)的參考值
得到對(duì)于
其第一下標(biāo)1表示工作空間性能表，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)，對(duì)于
其第一下標(biāo)2表示綜合強(qiáng)度性能指標(biāo)，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)，對(duì)于
，其第一下標(biāo)3表示平均控制能量指標(biāo)，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)，對(duì)于
，其第一下標(biāo)4表示平均控制時(shí)間指標(biāo)，第二下標(biāo)1表示第一次多目標(biāo)優(yōu)化設(shè)計(jì)；
由第一次多目標(biāo)優(yōu)化設(shè)計(jì)的參考值
及x1，0、x2，0、x3，0計(jì)算得到各廣義性能指標(biāo)的初始值Z1，0、Z2，0、Z3，0、Z4，0；如果Z1，0、Z2，0、Z3，0、Z4，0不全部為零，則進(jìn)入步驟3，1；如果Z1，0、Z2，0、Z3，0、Z4，0全部為零，則設(shè)計(jì)向量x1、x2、x3的初始值x1，0、x2，0、x3，0即為多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的值；
步驟3.1 對(duì)設(shè)計(jì)變量組成的向量x1、x2、x3進(jìn)行第一次迭代，迭代次數(shù)i＝1
首先，由第一控制律及對(duì)第一控制律產(chǎn)生的調(diào)整量v1，1幅度修正方法
如果
如果
生成對(duì)向量x1的第一次迭代的調(diào)整值v1，1，再用調(diào)整值v1，1調(diào)整向量x1，得到向量x1第一次迭代后的值x1，1＝x1，0+v1，1；這里，e1，0為廣義工作空間性能指標(biāo)在初始時(shí)刻的值Z1，0與目標(biāo)值0的誤差，e1，0＝0—Z1，0；e2，0為廣義綜合強(qiáng)度性能指標(biāo)在初始時(shí)刻的值Z2，0與目標(biāo)值0的誤差，e2，0＝0—Z2，0；e3，0為廣義平均控制能量指標(biāo)在初始時(shí)刻的值Z3，0與目標(biāo)值0的誤差，e3，0＝0—Z3，0；e4，0為廣義平均控制時(shí)間指標(biāo)在初始時(shí)刻的值Z4，0與目標(biāo)值0的誤差，e4，0＝0—Z4，0；
為誤差值e1，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e2，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e3，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e4，0相對(duì)于設(shè)計(jì)向量值x1，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
其次，由第二控制律及對(duì)第二控制律產(chǎn)生的調(diào)整量v2，1的幅度修正方法
如果
如果
生成對(duì)臂厚設(shè)計(jì)向量x2的第一次迭代的調(diào)整值v2，1’用調(diào)整值v2，1調(diào)整臂厚設(shè)計(jì)向量x2，得到向量x2的第一次迭代后的值x2，1＝x2，0+v2，1；這里，
為誤差值e2，0相對(duì)于設(shè)計(jì)向量值x2，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e3，0相對(duì)于設(shè)計(jì)向量值x2，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
再次，由第三控制律及對(duì)第三控制律產(chǎn)生的調(diào)整量v3，1的幅度修正方法
如果
如果
生成對(duì)關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的第一次調(diào)整值v3，1’用調(diào)整值v3，1調(diào)整關(guān)節(jié)運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3，得到設(shè)計(jì)向量x3的第一次迭代后的值x3，1＝x3，0+v3，1；這里，
為誤差值e2，0相對(duì)于x3，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e3，0相對(duì)于設(shè)計(jì)向量值x3，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e4，0相對(duì)于設(shè)計(jì)向量值x3，0的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
最后，在得到設(shè)計(jì)向量x1、x2、x3的第一次迭代后的向量值x1，1、x2，1、x3，1之后，計(jì)算第一次調(diào)整后各廣義性能的值Z1，1、Z2，1、Z3，1、Z4，1，如果Z1，1、Z2，1、Z3，1、Z4，1不全部為零，則進(jìn)入步驟3.2；如果Z1，1、Z2，1、Z3，1、Z4，1全部為零，則所得到的向量x1、x2、x3的第一次迭代的值x1，1、x2，1、x3，1為多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)；
步驟3.2 對(duì)設(shè)計(jì)變量組成的向量x1、x2、x3進(jìn)行第二次迭代，迭代次數(shù)i＝2首先，由第一控制律及對(duì)第一控制律產(chǎn)生的調(diào)整量v1，2幅度修正方法
如果
如果
生成對(duì)向量x1的第二次迭代的調(diào)整值v1，2，再用調(diào)整值v1，2調(diào)整向量x2，得到第二次迭代后設(shè)計(jì)向量x1的值x1，2＝x1，1+v1，2；這里，e1，1為廣義工作空間性能指標(biāo)在第一次迭代后的值Z1，1與目標(biāo)值0的誤差，e1，1＝0—Z1，1；e2，1為廣義綜合強(qiáng)度性能指標(biāo)在第一次迭代后的值Z2，1與目標(biāo)值0的誤差，e2，1＝0—Z2，1；e3，1為廣義平均控制能量性能指標(biāo)在第一次迭代后的值Z3，1與目標(biāo)值0的誤差，e3，1＝0—Z3，1；e4，1為廣義平均控制能量性能指標(biāo)在第一次迭代后的值Z4，1與目標(biāo)值0的誤差，e4，1＝0—Z4，1；
為誤差值e1，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e2，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e3，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e4，1相對(duì)于設(shè)計(jì)向量值x1，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
其次，由第二控制律及對(duì)第二控制律產(chǎn)生的調(diào)整量v2，2的幅度修正方法
如果
如果
生成設(shè)計(jì)向量x2進(jìn)行第二次迭代的調(diào)整值再用調(diào)整值v2，2調(diào)整設(shè)計(jì)向量x2的值，得到第二次迭代后設(shè)計(jì)向量x2的值x2，2＝x2，1+v2，2；這里，
為誤差值e2，1相對(duì)于設(shè)計(jì)向量值x2，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e3，1相對(duì)于設(shè)計(jì)向量值x2，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
再次，由第三控制律及對(duì)第三控制律產(chǎn)生的調(diào)整量v3，2的幅度修正方法
如果
如果
生成設(shè)計(jì)向量x3的第二次迭代的調(diào)整值，再用調(diào)整值v3，2調(diào)整設(shè)計(jì)向量x3的值，得到第二次迭代后向量x3的值x3，2＝x3，1+v3，2；這里，
為e2，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e3，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
為誤差值e4，1相對(duì)于設(shè)計(jì)向量值x3，1的負(fù)偏導(dǎo)數(shù)對(duì)應(yīng)的符號(hào)向量，
最后，用得到的設(shè)計(jì)向量x1、x2、x3第二次迭代后的值x1，2、x2，2、x3，2，計(jì)算第二次迭代后各廣義性能的值Z1，2、Z2，2、Z3，2、Z4，2，如果Z1，2、Z2，2、Z3，2、Z4，2不全部為零，則進(jìn)入步驟3.3；如果Z1，2、Z2，2、Z3，2、Z4，2全部為零，則所得到的向量x1、x2、x3的第二次迭代的值x1，2、x2，2、x3，2即為多目標(biāo)優(yōu)化設(shè)計(jì)參數(shù)的值；
步驟3.3 依此類(lèi)推，通過(guò)第一控制律及對(duì)第一控制律產(chǎn)生的調(diào)整量幅度的修正方法，生成設(shè)計(jì)向量x1進(jìn)行第j次迭代的調(diào)整值v1，j；通過(guò)第二控制律及對(duì)第二控制律產(chǎn)生的調(diào)整量幅度的修正方法，生成設(shè)計(jì)向量x2進(jìn)行第j次迭代的調(diào)整值v2，j；通過(guò)第三控制律及對(duì)第三控制律產(chǎn)生的調(diào)整量幅度的修正方法，生成設(shè)計(jì)向量x3進(jìn)行第j次迭代的調(diào)整值v3，j；重復(fù)上述迭代，如果在100次迭代內(nèi)通過(guò)調(diào)整臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的值可以使廣義工作空間性能指標(biāo)Z1、廣義綜合強(qiáng)度性能指標(biāo)Z2、廣義平均控制能量指標(biāo)Z3、廣義平均控制時(shí)間指標(biāo)Z4的值同時(shí)為零，則獲得最終獲得使各性能同時(shí)得到優(yōu)化的臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的設(shè)計(jì)值；如果在100次迭代內(nèi)無(wú)法使得廣義工作空間性能指標(biāo)Z1、廣義綜合強(qiáng)度性能指標(biāo)Z2、廣義平均控制能量指標(biāo)Z3、廣義平均控制時(shí)間指標(biāo)Z4的值同時(shí)為零，則進(jìn)入步驟3.4，直到各廣義性能在100次迭代內(nèi)使得廣義性能指標(biāo)Z1、Z2、Z3、Z4的值同時(shí)為零，獲得最終獲得使各性能同時(shí)得到優(yōu)化的臂長(zhǎng)設(shè)計(jì)向量x1、臂厚設(shè)計(jì)向量x2、運(yùn)動(dòng)學(xué)能力設(shè)計(jì)向量x3的最終設(shè)計(jì)值；
步驟3.4 對(duì)各性能指標(biāo)期望值
的期望值進(jìn)行第n—1次調(diào)整后進(jìn)行第n次優(yōu)化設(shè)計(jì)，令n為優(yōu)化設(shè)計(jì)的次數(shù)，對(duì)設(shè)計(jì)向量x1、x2、x3進(jìn)行第n次優(yōu)化設(shè)計(jì)，重復(fù)步驟3.1～步驟3.3。
全文摘要
一種工業(yè)機(jī)器人多目標(biāo)優(yōu)化設(shè)計(jì)的方法。該方法由三個(gè)步驟組成首先，通過(guò)建立機(jī)械臂運(yùn)動(dòng)學(xué)模型、強(qiáng)度分析模型、基于機(jī)電耦合系統(tǒng)動(dòng)力學(xué)模型及逆動(dòng)力學(xué)控制的系統(tǒng)閉環(huán)模型，獲得表征機(jī)械臂工作空間、強(qiáng)度、控制能量、控制時(shí)間的四個(gè)性能指標(biāo)及其計(jì)算方法；其次，對(duì)四個(gè)性能指標(biāo)涉及到的機(jī)器人設(shè)計(jì)參數(shù)進(jìn)行選擇性優(yōu)化，建立了多目標(biāo)優(yōu)化設(shè)計(jì)模型；最后，通過(guò)控制的方法，對(duì)機(jī)械臂的設(shè)計(jì)參數(shù)進(jìn)行調(diào)整，對(duì)四個(gè)目標(biāo)進(jìn)行并行優(yōu)化，最終獲得同時(shí)滿足四個(gè)性能要求的設(shè)計(jì)參數(shù)的設(shè)計(jì)值，從而為整體提高工業(yè)機(jī)器人性能提供了一種方法。
文檔編號(hào)G06F17/50GK101508112SQ20091003006
公開(kāi)日2009年8月19日 申請(qǐng)日期2009年3月30日 優(yōu)先權(quán)日2009年3月30日
發(fā)明者崢 汪, 琦 陳, 佳 胡 申請(qǐng)人:東南大學(xué)