劉喜藏， 馬銘澤， 林 皓

(航空工業(yè)第一飛機(jī)設(shè)計(jì)研究院，陜西 西安 710089)

飛行模擬器作為重要的地面仿真設(shè)備，是典型的人在回路實(shí)時(shí)仿真系統(tǒng)。六自由度運(yùn)動(dòng)平臺(tái)作為飛行模擬器的重要組成部分，其根據(jù)飛機(jī)的飛行狀態(tài)進(jìn)行實(shí)時(shí)解算并控制平臺(tái)進(jìn)行俯仰、滾轉(zhuǎn)、偏航、升降、縱向和側(cè)向平移運(yùn)動(dòng)，從而為飛行員提供瞬態(tài)過載感受[1]。六自由運(yùn)動(dòng)平臺(tái)的結(jié)構(gòu)形式多種多樣，其中并聯(lián)結(jié)構(gòu)形式因其具有精度高、剛度大、運(yùn)動(dòng)速度快等特點(diǎn)而被廣泛應(yīng)用。并聯(lián)結(jié)構(gòu)六自由度運(yùn)動(dòng)平臺(tái)的控制目標(biāo)與作動(dòng)系統(tǒng)之間是較為復(fù)雜的非線性關(guān)系，建立運(yùn)動(dòng)平臺(tái)的運(yùn)動(dòng)學(xué)關(guān)系是進(jìn)行系統(tǒng)結(jié)構(gòu)設(shè)計(jì)、運(yùn)動(dòng)誤差分析和實(shí)現(xiàn)系統(tǒng)精確、快速控制的重要前提條件。

針對(duì)并聯(lián)結(jié)構(gòu)形式的運(yùn)動(dòng)學(xué)研究具有逆解容易、正解難的特點(diǎn)，目前已有大量學(xué)者開展了相關(guān)研究，綜合近年研究成果，可劃分以下3類：數(shù)值法、解析法和基于高級(jí)算法的求解法[2]。其中，最典型的數(shù)值法便是牛頓迭代法，其求解原理簡(jiǎn)單易懂，只要迭代次數(shù)足夠，就能求得滿足精度要求的方程解，但迭代初值的選擇會(huì)影響該方法的迭代速度和尋優(yōu)結(jié)果。陳曉江[3]通過將運(yùn)動(dòng)學(xué)正解方程表示為9個(gè)方程組，采用牛頓迭代法進(jìn)行了求解。楊小龍[4]使用了一種牛頓迭代法的優(yōu)化算法，通過構(gòu)造迭代序列，完成了運(yùn)動(dòng)學(xué)正解求解，并將求解效率提高到0.3 ms。解析法通常采用消元方式消去約束方程中的未知數(shù)，從而獲得方程解。通過解析解可以求得所有解，然而其推導(dǎo)過程十分復(fù)雜。Dietmaier[5]證明了一般 6-UPS 機(jī)器人有 40 個(gè)實(shí)數(shù)解。對(duì)于6-UPS機(jī)器人，Sreenivasan等[6]證明最多有 16 個(gè)解，當(dāng)上、下平臺(tái)是對(duì)稱六邊形時(shí)，Huang等[7]證明最多有 14 個(gè)解。為解決運(yùn)動(dòng)學(xué)正解解算問題，胡啟國(guó)[8]、弓瑞[9]等采用遺傳算法求得平臺(tái)的位姿正解，該算法的解算精度較高，但其尋優(yōu)解算用時(shí)較長(zhǎng)。荊學(xué)東[10]、朱齊丹[11]等采用神經(jīng)網(wǎng)絡(luò)、牛頓迭代混合的算法完成了Stewart平臺(tái)的正解，其迭代效率和解算誤差均優(yōu)于傳統(tǒng)BP神經(jīng)網(wǎng)絡(luò)算法。

在進(jìn)行六自由度運(yùn)動(dòng)平臺(tái)設(shè)計(jì)時(shí)應(yīng)避免奇異結(jié)構(gòu)的出現(xiàn)，因此其包線內(nèi)的運(yùn)動(dòng)學(xué)正解是唯一的。采用遺傳算法、神經(jīng)網(wǎng)絡(luò)等先進(jìn)算法進(jìn)行運(yùn)動(dòng)學(xué)求解時(shí)需要進(jìn)行大量的樣本訓(xùn)練，很多時(shí)候也需要使用牛頓迭代法。六自由度運(yùn)動(dòng)平臺(tái)的空間包線較小，非常適合采用牛頓迭代法進(jìn)行運(yùn)動(dòng)學(xué)正解求解。改進(jìn)的牛頓迭代法雖然效率較高，然而其構(gòu)造過程復(fù)雜。本文將從簡(jiǎn)化運(yùn)動(dòng)學(xué)正解方程出發(fā)，結(jié)合六自由度運(yùn)動(dòng)平臺(tái)的使用特點(diǎn)，通過選擇合理的迭代初值完成位置正解的高效迭代尋優(yōu)，同時(shí)利用解析法完成平臺(tái)速度和加速度正解求解。

1 六自由度運(yùn)動(dòng)平臺(tái)

一個(gè)典型的六自由度運(yùn)動(dòng)平臺(tái)如圖1所示，可以將其劃分為上平臺(tái)、下平臺(tái)和支腿，其中下平臺(tái)固定在地面上，支腿與上、下平臺(tái)相交的位置為鉸鏈點(diǎn)，同一平面上的鉸鏈點(diǎn)位于同心圓上。

圖1 六自由度運(yùn)動(dòng)平臺(tái)結(jié)構(gòu)圖

支腿可以繞上、下鉸鏈進(jìn)行轉(zhuǎn)動(dòng)，并且支腿上部能進(jìn)行伸縮運(yùn)動(dòng)。通過控制6條支腿的伸縮運(yùn)動(dòng)來實(shí)現(xiàn)對(duì)上平臺(tái)的控制，從而為人在回路的仿真試驗(yàn)提供動(dòng)感效應(yīng)。

根據(jù)上、下平臺(tái)圓半徑、鉸鏈間距和支腿長(zhǎng)度即可確定平臺(tái)的空間結(jié)構(gòu)。平臺(tái)鉸鏈點(diǎn)的平面布局如圖2所示，d1～d6為下鉸鏈點(diǎn)，u1～u6為上鉸鏈點(diǎn)，同一平面上的鉸鏈點(diǎn)對(duì)稱分布。

圖2 運(yùn)動(dòng)平臺(tái)鉸鏈點(diǎn)平面分布圖

2 坐標(biāo)系定義

為了描述運(yùn)動(dòng)平臺(tái)各節(jié)點(diǎn)組成部分在空間的運(yùn)動(dòng)學(xué)關(guān)系，需要建立統(tǒng)一的坐標(biāo)系。

2.1 下平臺(tái)坐標(biāo)系

下平臺(tái)坐標(biāo)系(FI)坐標(biāo)原點(diǎn)OI位于下鉸鏈構(gòu)成大圓的圓心，OIxI軸垂直于下平臺(tái)d1、d2號(hào)鉸鏈點(diǎn)的連線，OIyI垂直于OIxI指向右，并與OIxI在同一水平面內(nèi)，如圖2(a)所示。OIzI鉛垂向下指向地心方向。

2.2 上平臺(tái)坐標(biāo)系

當(dāng)支腿的長(zhǎng)度相等且為某特定初始值Lt0時(shí)，即Lt1=Lt2=Lt3=Lt4=Lt5=Lt6=Lt0，上平臺(tái)與下平臺(tái)平行，并定義該位置為運(yùn)動(dòng)平臺(tái)中立位。規(guī)定此時(shí)的上平臺(tái)圓心Os為上平臺(tái)坐標(biāo)系(Fs)原點(diǎn)，縱軸Osxs垂直于上平臺(tái)u4、u5號(hào)鉸鏈點(diǎn)的連線，橫軸垂直于Osxs指向右，如圖2(b)所示。豎軸Oszs垂直于Osxsys平面，向下為正。上平臺(tái)坐標(biāo)系是一個(gè)可動(dòng)坐標(biāo)系，相對(duì)于下平臺(tái)坐標(biāo)系，除了坐標(biāo)原點(diǎn)的平移運(yùn)動(dòng)外，還包括俯仰、滾轉(zhuǎn)和偏航運(yùn)動(dòng)，其正方向定義與飛機(jī)歐拉角類似。

2.3 支腿坐標(biāo)系

為了描述支腿向量與上平臺(tái)、下平臺(tái)之間的關(guān)系，需要建立支腿坐標(biāo)系。下面以下平臺(tái)d5鉸鏈點(diǎn)所在的支腿坐標(biāo)系為例進(jìn)行說明：支腿慣性坐標(biāo)系Fa的縱軸Oaxa軸平行于下平臺(tái)相鄰鉸鏈點(diǎn)短邊中垂線，正方向指向大圓圓心，橫軸Oaya垂直于Oaxa軸，指向右側(cè)，如圖3所示。Oaza軸指向地心方向。

圖3 支腿坐標(biāo)系定義

3 運(yùn)動(dòng)學(xué)關(guān)系

六自由度運(yùn)動(dòng)平臺(tái)的上平臺(tái)通過支腿與下平臺(tái)相連，支腿坐標(biāo)系相對(duì)于支腿慣性坐標(biāo)系存在轉(zhuǎn)動(dòng)。建立支腿與上、下平臺(tái)之間的運(yùn)動(dòng)學(xué)關(guān)系，需要利用點(diǎn)的復(fù)合運(yùn)動(dòng)理論進(jìn)行分析。

3.1 點(diǎn)的復(fù)合運(yùn)動(dòng)

以任一支腿為例進(jìn)行復(fù)合運(yùn)動(dòng)分析，已知該支腿伸縮速度和伸縮加速度分別為vr1和ar1，其方向沿支腿方向；支腿繞下鉸鏈d1的角速度和角加速度分別為ωt1和αt1，其方向垂直于支腿矢量；支腿在慣性坐標(biāo)系下的空間矢量為r1。

圖4 支腿復(fù)合運(yùn)動(dòng)分析

根據(jù)速度合成定理，空間任一動(dòng)點(diǎn)的絕對(duì)速度等于其牽連速度與相對(duì)速度的矢量和[12],則上鉸鏈點(diǎn)u1相對(duì)于下鉸鏈點(diǎn)d1的速度為

va1=ωt1×r1+vr1

(1)

式中:ωt1×r1垂直于支腿方向；vr1沿支腿方向。

支腿上鉸鏈點(diǎn)相對(duì)于下鉸鏈的牽連運(yùn)動(dòng)為定軸轉(zhuǎn)動(dòng)與平移運(yùn)動(dòng)之和，根據(jù)定軸轉(zhuǎn)動(dòng)加速度合成定理，則上鉸鏈點(diǎn)u1相對(duì)于下鉸鏈點(diǎn)d1的加速度為

aa1=αt1×r1+ωt1×ωt1×r1+ar1+2ωt1×vr1

(2)

式中:αt1×r1垂直于支腿方向；ωt1×ωt1×r1沿支腿方向，其大小為|ωt1|2·|r1|；ar1沿支腿方向；ωt1×vr1垂直于支腿方向。

3.2 運(yùn)動(dòng)學(xué)方程

根據(jù)平臺(tái)結(jié)構(gòu)參數(shù)，可以確定鉸鏈點(diǎn)在相對(duì)應(yīng)同心圓上的位置。假設(shè)6個(gè)下鉸鏈點(diǎn)在FI坐標(biāo)系下的位置為Pd，6個(gè)上鉸鏈點(diǎn)在Fs坐標(biāo)系下的位置為Pu，Pd和Pu均為3×6的矩陣。

上平臺(tái)坐標(biāo)系原點(diǎn)Os在下平臺(tái)坐標(biāo)系FI下的位置、速度和加速度分別為PI=[x;y;z]，VI=[vxu;vyu;vzu]和AI=[axu;ayu;azu]；上平臺(tái)姿態(tài)角、角速度和角加速度分別為Euler=[θ;φ;ψ]，ωs=[p;q;r]和αs=[dp;dq;dr]。

6個(gè)支腿在FI坐標(biāo)系下的空間矢量為Pu2d，該矢量為3×6的矩陣。沿支腿方向的伸縮速度和伸縮加速度分別為vr和ar，均為6×1的矩陣。

根據(jù)上述定義，建立上平臺(tái)位姿、速度和加速度與支腿位置、速度和加速度的運(yùn)動(dòng)學(xué)對(duì)應(yīng)關(guān)系。

(1) 位置運(yùn)動(dòng)學(xué)關(guān)系。

根據(jù)上平臺(tái)的姿態(tài)角，可以得到體軸系-地軸系轉(zhuǎn)換矩陣Mbtg[13]，該矩陣為3×3方陣。利用該轉(zhuǎn)換矩陣可以將上平臺(tái)上任一點(diǎn)轉(zhuǎn)換到慣性坐標(biāo)系。

根據(jù)空間矢量定義，可以建立運(yùn)動(dòng)平臺(tái)位置對(duì)應(yīng)關(guān)系：

Pu2d(:,i)=PI+Mbtg·Pu(:,i)-Pd(:,i)，i=1,2,…,6

(3)

(2) 速度運(yùn)動(dòng)學(xué)關(guān)系。

假設(shè)上鉸鏈點(diǎn)在FI坐標(biāo)系下的速度為Vu，該矢量為3×6的矩陣，則

Vu(:,i)=VI+ωs×Pu(:,i)，i=1,2,…,6

(4)

結(jié)合式(1)中點(diǎn)的復(fù)合速度分析，Vu沿支腿方向的映射速度即為支腿的伸縮速度：

|vri|=Vu(:,i)·Pu2d(:,i)/|Pu2d(:,i)|，i=1,2,…,6

(5)

(3) 加速度運(yùn)動(dòng)學(xué)關(guān)系。

假設(shè)上鉸鏈點(diǎn)在FI坐標(biāo)系下的加速度為Au，該矢量為3×6的矩陣，則

Au(:,i)=AI+ωs×ωs×Pu(:,i)+αs×Pu(:,i)，i=1,2,…,6

(6)

上鉸鏈點(diǎn)慣性系下的速度Vu沿垂直支腿方向的映射分量是由支腿的轉(zhuǎn)動(dòng)產(chǎn)生的。假設(shè)支腿的角速度為ωt，ωt為3×6矩陣，結(jié)合式(1)可求得：

ωt(:,i)=Vu(:,i)×Pu2d(:,i)/|Pu2d(:,i)|，i=1,2,…,6

(7)

再結(jié)合式(2)，可求得支腿的伸縮加速度：

|ari|=Au(:,i)·Pu2d(:,i)/|Pu2d(:,i)|-|Pu2d(:,i)|·|ωt(:,i)|2，

i=1,2,…,6

(8)

至此，完成了上平臺(tái)與支腿之間的運(yùn)動(dòng)學(xué)關(guān)系映射。

4 運(yùn)動(dòng)學(xué)正、逆解

六自由度運(yùn)動(dòng)平臺(tái)的運(yùn)動(dòng)學(xué)正解是指根據(jù)支腿的位置、速度和加速度確定上平臺(tái)的位姿、速度和加速度的過程；而運(yùn)動(dòng)學(xué)逆解則是由上平臺(tái)的位姿、速度和加速度求解支腿的位置、速度和加速度的過程。可以將六自由度運(yùn)動(dòng)平臺(tái)看作是并聯(lián)結(jié)構(gòu)機(jī)器人，其運(yùn)動(dòng)學(xué)方程具有逆解容易、正解難的特點(diǎn)。

4.1 運(yùn)動(dòng)學(xué)逆解

已知上平臺(tái)的位置、姿態(tài)、速度、加速度、角速度和角加速度，基于式(3)、式(5)和式(8)，可以直接求得支腿的位置、伸縮速度和伸縮加速度，即完成運(yùn)動(dòng)學(xué)逆解，這里不再贅述。

4.2 運(yùn)動(dòng)學(xué)正解

4.2.1 位置正解

位置正解需要解決的問題可以描述為：已知運(yùn)動(dòng)系統(tǒng)的結(jié)構(gòu)參數(shù)，給定6個(gè)作動(dòng)筒的長(zhǎng)度Lt(i)，i=1,2,…，6，求解上平臺(tái)坐標(biāo)系原點(diǎn)位置PI=[x;y;z]和姿態(tài)Euler=[θ;φ;ψ]。對(duì)運(yùn)動(dòng)系統(tǒng)進(jìn)行位姿正解是一個(gè)求解高階非線性方程組的過程[3]。

利用式(3)，可得到以下方程組：

fi(x,y,z,θ,φ,ψ)=|PI+Mbtg·Pu(:,i)-Pd(:,i)|-Lt(i)=0，
i=1,2,…,6

(9)

則有一階泰勒展開式

可用矩陣表示為

0≈f(x(k))+J(x(k))(a-x(k))

解得：

a≈x(k)-J(x(k))-1f(x(k))

于是，就得到了牛頓迭代格式：

x(k+1)≈x(k)-J(x(k))-1f(x(k))

式中:J為雅可比矩陣。

當(dāng)f(x(k+1))滿足設(shè)定的誤差要求時(shí)，則認(rèn)為此時(shí)的x(k+1)為位置正解，即平臺(tái)的位置和姿態(tài)。

4.2.2 速度正解

速度正解需要解決的問題可以描述為：已知運(yùn)動(dòng)系統(tǒng)的結(jié)構(gòu)參數(shù)，給定6個(gè)作動(dòng)筒的長(zhǎng)度Lt(i)、伸縮速度|vri|，i=1,2,…,6，求解上平臺(tái)速度VI=[vxu;vyu;vzu]。

利用式(4)和式(5)，得到下面方程組：

gi(vxu,vyu,vzu)=(VI+ωs×Pu(:,i))·Pu2d(:,i)/
|Pu2d(:,i)|-|vri|=0，i=1,2,…,6

(10)

式(10)包含6個(gè)方程式，利用廣義擬求解方法可以求得上平臺(tái)的速度VI=[vxu;vyu;vzu]。

4.2.3 加速度正解

加速度正解需要解決的問題可以描述為：已知運(yùn)動(dòng)系統(tǒng)的結(jié)構(gòu)參數(shù)，給定6個(gè)作動(dòng)筒的長(zhǎng)度Lt(i)、伸縮速度|vri|、伸縮加速度|ari|，i=1,2,…,6，求解上平臺(tái)加速度AI=[axu;ayu;azu]。

利用式(6)～式(10)，得到下面方程組：

hi(axu,ayu,azu)=Au(:,i)·Pu2d(:,i)/|Pu2d(:,i)|-
|Pu2d(:,i)|·|ωt(:,i)|2-|ari|=0，i=1,2,…,6

(11)

式(11)包含6個(gè)方程式，利用廣義擬求解方法可以求得上平臺(tái)加速度AI=[axu;ayu;azu]。

4.3 運(yùn)動(dòng)學(xué)解算流程圖

六自由度運(yùn)動(dòng)平臺(tái)的運(yùn)動(dòng)學(xué)解算過程如圖5所示。根據(jù)平臺(tái)的結(jié)構(gòu)參數(shù)和上平臺(tái)目標(biāo)運(yùn)動(dòng)參數(shù)，經(jīng)運(yùn)動(dòng)學(xué)逆解得到支腿的位置、速度和加速度；利用運(yùn)動(dòng)學(xué)正解方程完成平臺(tái)位姿、速度和加速度的正解。

圖5 六自由度運(yùn)動(dòng)平臺(tái)運(yùn)動(dòng)學(xué)解算流程圖

5 仿真結(jié)果與分析

以某運(yùn)動(dòng)平臺(tái)結(jié)構(gòu)參數(shù)為例，對(duì)六自由度運(yùn)動(dòng)平臺(tái)的運(yùn)動(dòng)學(xué)關(guān)系進(jìn)行仿真建模和驗(yàn)證。該運(yùn)動(dòng)平臺(tái)結(jié)構(gòu)參數(shù)如表1所示。

表1 某運(yùn)動(dòng)平臺(tái)結(jié)構(gòu)參數(shù)列表 單位：mm

仿真模型結(jié)構(gòu)如圖6所示。模型由運(yùn)動(dòng)學(xué)逆解模塊、作動(dòng)系統(tǒng)、運(yùn)動(dòng)學(xué)正解模塊3個(gè)部分組成，模塊之間的關(guān)系如下。

圖6 六自由度運(yùn)動(dòng)平臺(tái)運(yùn)動(dòng)學(xué)模型結(jié)構(gòu)圖

① 運(yùn)動(dòng)學(xué)逆解模塊的輸入為平臺(tái)的目標(biāo)位置、速度、加速度、歐拉角、角速度和角加速度指令，經(jīng)運(yùn)動(dòng)學(xué)逆解解算后，得到支腿的作動(dòng)指令。

② 作動(dòng)系統(tǒng)根據(jù)作動(dòng)指令驅(qū)動(dòng)支腿運(yùn)動(dòng)，并可以通過電機(jī)編碼器得到支腿的實(shí)際位置、速度和加速度。

③ 將支腿運(yùn)動(dòng)狀態(tài)輸入運(yùn)動(dòng)學(xué)正解模塊，解算得到平臺(tái)的實(shí)際運(yùn)動(dòng)狀態(tài)。

為了驗(yàn)證平臺(tái)的運(yùn)動(dòng)學(xué)關(guān)系，這里假設(shè)作動(dòng)系統(tǒng)為無延遲的理想環(huán)節(jié)，則平臺(tái)目標(biāo)運(yùn)動(dòng)指令值應(yīng)與運(yùn)動(dòng)學(xué)正解模塊解算得到的平臺(tái)狀態(tài)一致。

5.1 模型解算性能分析

運(yùn)動(dòng)學(xué)模型中的運(yùn)動(dòng)學(xué)逆解模塊可以看作線性定常系統(tǒng)，其解算速度很快。又因?yàn)樗俣群图铀俣日夥匠桃彩蔷€性的，因此重點(diǎn)對(duì)運(yùn)動(dòng)學(xué)位姿正解解算過程進(jìn)行分析。

選擇3個(gè)不同的支腿長(zhǎng)度狀態(tài)作為運(yùn)動(dòng)學(xué)正解模塊輸入，以平臺(tái)位于中立位作為迭代尋優(yōu)初值，尋優(yōu)過程如表2所示。其中狀態(tài)點(diǎn)1=[4795;4795;4795;3295;3295;3295]，狀態(tài)點(diǎn)2=[3300;3581;4158;4521;3854;4029]，狀態(tài)點(diǎn)3= [3500;4795;4500;3600;3800;4300]。

表2 運(yùn)動(dòng)學(xué)正解迭代尋優(yōu)過程

由表2可知，對(duì)于不同的支腿狀態(tài)，經(jīng)5次迭代尋優(yōu)后，即可得到上平臺(tái)的位姿參數(shù)。尋優(yōu)耗時(shí)不超過2 ms，均方差小于1，完全滿足工程應(yīng)用實(shí)時(shí)性要求。

將迭代過程的均方差用圖形表示出來，如圖7所示，可以更好地展示尋優(yōu)收斂速度。事實(shí)上，經(jīng)過4次迭代后的解算精度已經(jīng)很高。

圖7 尋優(yōu)結(jié)果均方差隨迭代次數(shù)增加變化圖

采用牛頓迭代法進(jìn)行位姿正解求解，不同的迭代初值會(huì)影響模型的解算效率。下面將通過選擇不同的迭代初值對(duì)迭代結(jié)果和效率進(jìn)行分析。

假定迭代初值為上平臺(tái)圓心在下平臺(tái)坐標(biāo)系下的位姿，尋優(yōu)初值1=x(0)=(0,0,3000,0°,0°,0°)位于下平臺(tái)以下，即不在運(yùn)動(dòng)平臺(tái)包線范圍內(nèi)。尋優(yōu)初值2=x(0)=(0,0,-6000,0°,0°,0°)位于下平臺(tái)之上，同樣超過系統(tǒng)的包線范圍。尋優(yōu)初值3=x(0)=(0,0,-3147,0°,0°,0°)是平臺(tái)位于中立位時(shí)的上平臺(tái)位姿參數(shù)。針對(duì)狀態(tài)點(diǎn)1～狀態(tài)點(diǎn)3，采用不同的迭代初值進(jìn)行解算，尋優(yōu)結(jié)果如表3所示。

表3 不同迭代初值的尋優(yōu)結(jié)果

由表3可知，不合理的初值設(shè)定(例如初值1)，會(huì)導(dǎo)致尋優(yōu)結(jié)果不在運(yùn)動(dòng)系統(tǒng)包線范圍內(nèi)；而將初值設(shè)定在下平臺(tái)之上的兩個(gè)狀態(tài)點(diǎn)，尋優(yōu)結(jié)果合理且唯一，初值與尋優(yōu)結(jié)果較近的狀態(tài)點(diǎn)尋優(yōu)時(shí)間略短，總體尋優(yōu)時(shí)間均不超過2 ms。

考慮飛行模擬器六自由度運(yùn)動(dòng)平臺(tái)的工作特點(diǎn)：平臺(tái)每次均從中立位開始運(yùn)動(dòng)，在洗出算法影響下選擇“初值3”，即平臺(tái)中立位的位姿作為迭代初值，原因如下：① 運(yùn)動(dòng)平臺(tái)的初始運(yùn)動(dòng)均從中立位開始；② 每完成一次突發(fā)運(yùn)動(dòng)，在洗出算法的影響下平臺(tái)會(huì)“悄悄”回到中立位[14-15]。因此，選擇中立位的位姿作為迭代初值可以最大限度地減少尋優(yōu)時(shí)間。

5.2 運(yùn)動(dòng)包線解算

在進(jìn)行運(yùn)動(dòng)平臺(tái)包線計(jì)算時(shí)，將6個(gè)支腿由最短到最長(zhǎng)進(jìn)行遍歷，由此求得上平臺(tái)的最大空間狀態(tài)即為平臺(tái)的運(yùn)動(dòng)包線。以單個(gè)支腿取100個(gè)特征點(diǎn)為例，則完成支腿的遍歷需要進(jìn)行1006次計(jì)算。假設(shè)單次計(jì)算耗時(shí)1 ms，完成包線計(jì)算時(shí)間需要超過26萬小時(shí)。

筆者提出一種計(jì)算運(yùn)動(dòng)平臺(tái)包線的可行方案，即每個(gè)支腿只選擇最長(zhǎng)、最短2個(gè)狀態(tài)進(jìn)行遍歷，經(jīng)過26=64次計(jì)算，即可完成運(yùn)動(dòng)包線解算。

表4中的L為0代表最短支腿長(zhǎng)度，1代表最長(zhǎng)支腿長(zhǎng)度。完成表4中運(yùn)動(dòng)系統(tǒng)的包線解算僅用時(shí)55 ms。由計(jì)算結(jié)果可知，本文建模所用的六自由度運(yùn)動(dòng)平臺(tái)縱向運(yùn)動(dòng)范圍為±1.5 m，側(cè)向運(yùn)動(dòng)范圍為±1.6 m，垂向運(yùn)動(dòng)范圍為±0.9 m。平臺(tái)的空間包線是其重要性能指標(biāo)，一定程度上決定了平臺(tái)的運(yùn)動(dòng)能力。

表4 六自由度運(yùn)動(dòng)平臺(tái)空間包線

5.3 復(fù)合運(yùn)動(dòng)分析

選取一組正弦波復(fù)合運(yùn)動(dòng)數(shù)據(jù)作為上平臺(tái)指令值輸入，經(jīng)運(yùn)動(dòng)學(xué)逆解模塊解算后，得到6個(gè)支腿的作動(dòng)指令，經(jīng)作動(dòng)系統(tǒng)后驅(qū)動(dòng)上平臺(tái)運(yùn)動(dòng)。將上平臺(tái)的指令值與運(yùn)動(dòng)學(xué)正解模塊輸出值進(jìn)行對(duì)比，如圖8～圖10所示。

圖8 平臺(tái)位置指令與響應(yīng)值對(duì)比

由圖9和圖10可知，平臺(tái)的指令值與響應(yīng)值完全一致，證明了所建立的六自由度運(yùn)動(dòng)平臺(tái)運(yùn)動(dòng)學(xué)關(guān)系正確。當(dāng)然，對(duì)于實(shí)際作動(dòng)系統(tǒng)，平臺(tái)指令值與響應(yīng)值之間將存在一定的延遲與偏差。

圖9 平臺(tái)速度指令與響應(yīng)值對(duì)比

圖10 平臺(tái)加速度指令與響應(yīng)值對(duì)比

6 結(jié)論

通過引入點(diǎn)的復(fù)合運(yùn)動(dòng)理論，建立了平臺(tái)與支腿之間的位置、速度、加速度運(yùn)動(dòng)學(xué)關(guān)系。利用MATLAB/Simulink環(huán)境搭建了運(yùn)動(dòng)學(xué)模型，并設(shè)計(jì)了合理的驗(yàn)證方法。仿真結(jié)果表明,所建立的運(yùn)動(dòng)學(xué)模型具有解算速度快、準(zhǔn)確度高等特點(diǎn)，可滿足工程實(shí)時(shí)解算需求。本文的創(chuàng)新點(diǎn)和貢獻(xiàn)如下：

① 針對(duì)六自由度運(yùn)動(dòng)平臺(tái)的非奇異結(jié)構(gòu)特點(diǎn)，選擇牛頓迭代法完成運(yùn)動(dòng)學(xué)位置正解求解；提出了一種合理的初值選擇方法，并證明了合理區(qū)域內(nèi)即使初值與尋優(yōu)結(jié)果差異較大，也可以完成算法的快速收斂。

② 分析指出采用遍歷的方法求得運(yùn)動(dòng)系統(tǒng)的包線非常困難，給出了一種可行的運(yùn)動(dòng)包線尋找方法，通過6個(gè)支腿的狀態(tài)組合完成了運(yùn)動(dòng)平臺(tái)空間包線的計(jì)算。

③ 在完成位置正解的基礎(chǔ)上，創(chuàng)新性地引入點(diǎn)的復(fù)合運(yùn)動(dòng)理論，利用解析的方法完成了六自由度運(yùn)動(dòng)系統(tǒng)速度和加速度正解，為作動(dòng)系統(tǒng)伺服電機(jī)控制引入了更多的控制參數(shù)，有助于提高控制精度。