并聯(lián)機(jī)構(gòu)支鏈誤差耦合分析

趙俊杰，周曉靜，雷俊松

（1.河北工業(yè)職業(yè)技術(shù)學(xué)院宣鋼分院，河北張家口 075100；2.珠海格力電器股份有限公司，廣東珠海 519000）

0 引言

并聯(lián)機(jī)構(gòu)已經(jīng)廣泛應(yīng)用于實(shí)際生產(chǎn)中，如數(shù)控加工、精密裝配、航天等領(lǐng)域。精度的高低是評(píng)價(jià)機(jī)構(gòu)性能的重要指標(biāo)之一[1]，故對(duì)并聯(lián)機(jī)構(gòu)精度研究十分必要。張國(guó)慶[2]利用矢量鏈法和數(shù)值法對(duì)六自由度機(jī)器人進(jìn)行了標(biāo)定和分析；樊銳[3]對(duì)6PUS并聯(lián)機(jī)構(gòu)運(yùn)用最小二乘法進(jìn)行了整機(jī)標(biāo)定；張文昌[4]使用激光跟蹤儀對(duì)Delta機(jī)構(gòu)進(jìn)行了運(yùn)動(dòng)學(xué)誤差標(biāo)定；黃田[5]利用矢量鏈法對(duì)一種含有平行四邊形機(jī)構(gòu)進(jìn)行了誤差分析，并對(duì)誤差進(jìn)行了靈敏度分析；汪勁松[6]利用D－H法對(duì)Stewart機(jī)構(gòu)建立了誤差模型，但是上述理論是通過(guò)不同的方式建立起機(jī)構(gòu)定平臺(tái)到機(jī)構(gòu)末端點(diǎn)的單支鏈誤差方程，并沒(méi)有關(guān)于研究分析各個(gè)支鏈誤差耦合之后末端點(diǎn)的精度問(wèn)題，即沒(méi)有研究并聯(lián)機(jī)構(gòu)各支鏈誤差耦合。目前對(duì)于并聯(lián)機(jī)構(gòu)精度問(wèn)題國(guó)內(nèi)外主要學(xué)者側(cè)重于使用不同的方法建立機(jī)構(gòu)誤差模型，同時(shí)使用不同算法進(jìn)行誤差參數(shù)辨識(shí)。本文以三自由度并聯(lián)機(jī)構(gòu)[7]為研究對(duì)象，將各個(gè)支鏈疊加后的誤差分別加入到該機(jī)構(gòu)正解解析法和數(shù)值法中，對(duì)比分析結(jié)果一致，說(shuō)明該方法的有效性，進(jìn)而使用該方法對(duì)Stewart機(jī)構(gòu)進(jìn)行分析。

1 三自由度并聯(lián)機(jī)構(gòu)誤差耦合分析

1.1 誤差模型

本文所研究的三自由度并聯(lián)機(jī)構(gòu)是由動(dòng)平臺(tái)、靜平臺(tái)以及連接動(dòng)靜平臺(tái)的3條支鏈所組成的，具體如圖1所示。3條支鏈互呈120°對(duì)稱(chēng)，每條支鏈?zhǔn)怯芍е?、滑塊、平行四邊形結(jié)構(gòu)支鏈組成，安放在立柱上的滾珠絲杠通過(guò)電機(jī)帶動(dòng)，使得立柱上的滑塊上下移動(dòng)，滑塊同時(shí)通過(guò)轉(zhuǎn)動(dòng)副連接平行四邊形結(jié)構(gòu)的一端的短桿，平行四邊形結(jié)構(gòu)另一端的短桿通過(guò)轉(zhuǎn)動(dòng)副連接到動(dòng)平臺(tái)上，3條支鏈相互作用，使動(dòng)平臺(tái)能夠進(jìn)行三自由度移動(dòng)。

圖1 三自由度并聯(lián)機(jī)構(gòu)坐標(biāo)系

首先建立坐標(biāo)系。靜平臺(tái)定參考坐標(biāo)系{O}建立，xy平面為靜平臺(tái)上3個(gè)頂點(diǎn)理想位置所構(gòu)成的平面，x軸指向A1，z軸方向垂直于xy平面并朝上，y軸滿足右手定則，坐標(biāo)系的原點(diǎn)O位于靜平臺(tái)中心。坐標(biāo)系{Oi}建立，坐標(biāo)系{Oi}和坐標(biāo)系{O}原點(diǎn)完全重合，坐標(biāo)系{O1}和坐標(biāo)系{O}各軸方向一致，坐標(biāo)系{O2}和{O3}分別繞坐標(biāo)系{O}的z軸逆時(shí)針旋轉(zhuǎn)2π/3和4π/3。頂點(diǎn)坐標(biāo)系{Ai}建立，其坐標(biāo)系的原點(diǎn)為靜平臺(tái)3個(gè)Ai頂點(diǎn)，坐標(biāo)系{Ai}各個(gè)軸的方向和坐標(biāo)系{Oi}各個(gè)軸的方向重合。頂點(diǎn)坐標(biāo)系各個(gè)頂點(diǎn)的名義矢量和誤差矢量分別為ai和Δai，坐標(biāo)系{Ai}的姿態(tài)誤差矢量為θAi。由點(diǎn)Ai至點(diǎn)Bi的名義值和誤差值分別為mi和Δmi?；瑝K坐標(biāo)系{Bi}建立，原點(diǎn)為鉸鏈轉(zhuǎn)動(dòng)軸心Bi，坐標(biāo)系{Bi}各個(gè)軸的方向和坐標(biāo)系{Ai}各個(gè)軸的方向重合。點(diǎn)Bi坐標(biāo)系名義矢量和誤差矢量為bi和Δbi，坐標(biāo)系{Bi}的姿態(tài)誤差矢量為θBi。平行四邊形結(jié)構(gòu)端點(diǎn)鉸鏈坐標(biāo)系{Bij}建立，原點(diǎn)為鉸鏈轉(zhuǎn)動(dòng)軸心Bij，其中y軸與兩鉸鏈中心線連線重合，箭頭的方向由Bi指向Bij，z軸指向靜平臺(tái)，x軸滿足右手定則，兩鉸鏈轉(zhuǎn)動(dòng)中心名義值及誤差值分別為e和Δbij。動(dòng)平臺(tái)定參考系{P}建立，原點(diǎn)P位于動(dòng)平臺(tái)中心，xy平面平行于靜平臺(tái)，x軸指向C1，z軸垂直于動(dòng)平臺(tái)向上，y軸滿足右手定則。坐標(biāo)系{P1}和坐標(biāo)系{P}重合，坐標(biāo)系{P2}是繞坐標(biāo)系{P}的z軸旋轉(zhuǎn)2π/3而形成的，坐標(biāo)系{P3}是繞坐標(biāo)系{P}的z軸旋轉(zhuǎn)4π/3而形成的。坐標(biāo)系{P}相對(duì)于靜平臺(tái)定參考系{O}的誤差矢量為θ。鉸鏈坐標(biāo)系{Ci}建立，原點(diǎn)為動(dòng)平臺(tái)鉸鏈轉(zhuǎn)動(dòng)軸心Ci，坐標(biāo)系{Ci}各個(gè)軸向方向和坐標(biāo)系各個(gè)軸向{Pi}重合，點(diǎn)Ci坐標(biāo)系名義矢量和誤差矢量為ci和Δci，坐標(biāo)系{Ci}的姿態(tài)誤差矢量為θci。鉸鏈坐標(biāo)系{Cij}建立，原點(diǎn)為點(diǎn)Cij，其y軸與兩鉸鏈中心軸線連線重合，箭頭方向是由轉(zhuǎn)動(dòng)副指向鉸鏈，兩鉸鏈轉(zhuǎn)動(dòng)中心名義值及誤差值分別為e和Δcij。連桿li的方向是由Bij指向Cij，平行四邊形結(jié)構(gòu)的長(zhǎng)桿桿長(zhǎng)的名義值和誤差值分別為L(zhǎng)和ΔLi，方向單位矢量的理論值和誤差值分別為wi和Δwi。

在坐標(biāo)系O－xyz下，根據(jù)矢量鏈法建立機(jī)構(gòu)位姿閉環(huán)約束方程[5]。

式中：i＝1，2，3；j＝1，2；e2＝[0，1，0]T；e3＝[0，0，1]T。

對(duì)式（1）進(jìn)行1階攝動(dòng)得[6]：

式中：Δpp為點(diǎn)P的3×1階位置誤差，Ri為指靜平臺(tái)坐標(biāo)系{O}相對(duì)于坐標(biāo)系{Oi}的轉(zhuǎn)換矩陣。

根據(jù)式（3）中j的不同取值，可知每條支鏈都有兩個(gè)方程，將第i條支鏈的兩個(gè)平行四邊形的方程分別相減得式（4）：

根據(jù)式（3）中j的不同取值，可知每條支鏈都有2個(gè)方程，將第i條支鏈的2個(gè)平行四邊形的方程分別相加，并加式（4）中的θ代入得：

通過(guò)對(duì)式（5）分析得知，θBizRie3在（Rie3×wi）上投影為0，由此得出影響姿態(tài)的誤差源個(gè)數(shù)總共為30個(gè)，分別是

1.2 并聯(lián)機(jī)構(gòu)正解

機(jī)構(gòu)正解是指已知其驅(qū)動(dòng)量的大小，通過(guò)計(jì)算求解得機(jī)構(gòu)末端位置和姿態(tài)[2]。并聯(lián)機(jī)構(gòu)正解一般有2種方式：（1）解析法，即利用并聯(lián)機(jī)構(gòu)桿長(zhǎng)和位置關(guān)系建立多元二次方程組；（2）數(shù)值法，利用數(shù)值迭代的方法逐步逼近機(jī)構(gòu)的位置。解析法的特點(diǎn)是計(jì)算快、能夠求出所有解，但缺點(diǎn)是因其是求多元二次方程組，求解的難度是隨著未知數(shù)的個(gè)數(shù)增加，對(duì)于多自由度機(jī)構(gòu)求解比較困難；數(shù)值法的特點(diǎn)是求解方法相對(duì)簡(jiǎn)單，但求解速度要比解析法慢。本文利用2種方法求解了三自由度并聯(lián)機(jī)構(gòu)。

（1）解析法

根據(jù)三自由度機(jī)構(gòu)的位置關(guān)系可以建立一組三元二次方程組，如式（6）所示。

由式（6b）、（6c）得：

將xp代入式（6b）、（6c）得：

把xp和yp代入到式（6a）中得：

其中：

（2）數(shù)值法

正解步驟如下。首先給出一組位置坐標(biāo)，并對(duì)其進(jìn)行位置反解，將反解出的滑塊位移和輸入滑塊位移進(jìn)行相減，若相減之后的值達(dá)到設(shè)定的精度要求則記錄該點(diǎn)位置；若沒(méi)有達(dá)到，利用相減的差值和代入之前位置坐標(biāo)的雅可比逆矩陣相乘，便得到一組修正位置，將得到修正位置和之前的位置坐標(biāo)相加得到新的位置，對(duì)該位置繼續(xù)求解滑塊位移。數(shù)值法正解流程如圖2所示。

圖2 并聯(lián)機(jī)構(gòu)正解流程

三自由度并聯(lián)機(jī)構(gòu)尺寸如下，定平臺(tái)直徑為1 500 mm，動(dòng)平臺(tái)直徑為700 mm，平行四邊形結(jié)構(gòu)，長(zhǎng)桿長(zhǎng)度為750 mm，短桿長(zhǎng)度為200 mm。在給定的工作空間z＝－600 mm，xy在圓r≤20 mm上選取72個(gè)點(diǎn)。利用Matlab對(duì)其進(jìn)行2種正解方法驗(yàn)證，其中數(shù)值法精度設(shè)定為0.000 001 mm。計(jì)算結(jié)果如圖3所示，其中橫坐標(biāo)代表測(cè)試點(diǎn)，縱坐標(biāo)為根號(hào)下x、y、z 3個(gè)方向誤差平方和，即從中可以知道，無(wú)論是解析法還是數(shù)值法，都能準(zhǔn)確地得到機(jī)構(gòu)的位置，還存在誤差的原因是計(jì)算機(jī)計(jì)算精度所致。

圖3 三自由度并聯(lián)機(jī)構(gòu)正解誤差

1.3 誤差耦合分析

本文只探討誤差耦合對(duì)于機(jī)構(gòu)精度的影響，誤差的隨機(jī)性不在此次研究范圍內(nèi)，所以將三自由度并聯(lián)機(jī)構(gòu)的各個(gè)誤差值設(shè)定為定值[7]。具體值如表1所示。

表1 三自由度并聯(lián)機(jī)構(gòu)誤差值 mm

將以上各個(gè)單鏈的誤差（共30個(gè)）參數(shù)代入式（5）各條支鏈誤差方程中，并進(jìn)行全局坐標(biāo)轉(zhuǎn)換，此時(shí)可以得到3條支鏈在全局下的坐標(biāo)誤差，再將每條單鏈上的誤差代入到三自由度正解的2種解法中。解析法誤差耦合如圖4所示，把各個(gè)單鏈累計(jì)后的誤差帶入該機(jī)構(gòu)正解方程，即式（6）中，由于支鏈誤差的存在改變了正解方程，將不含誤差的驅(qū)動(dòng)量代入方程中，可以得到此時(shí)該機(jī)構(gòu)將各支鏈誤差耦合之后末端位置的誤差。數(shù)值法誤差耦合如圖5所示，將各條支鏈上的誤差轉(zhuǎn)換為各條支鏈上的驅(qū)動(dòng)誤差，最終將驅(qū)動(dòng)誤差通過(guò)數(shù)值法轉(zhuǎn)換為末端的位置誤差。繼續(xù)使用正解中的72個(gè)點(diǎn)進(jìn)行分析，其結(jié)果如圖6～8所示，其分別代表了每條支鏈上不同方向的誤差和經(jīng)過(guò)耦合代入正解中的各個(gè)軸向的誤差。通過(guò)觀察，發(fā)現(xiàn)2種正解方法得出的耦合誤差結(jié)果相同，相互印證了利用正解方法代入求出機(jī)構(gòu)末端位置誤差的有效性；其次，通過(guò)分析對(duì)比發(fā)現(xiàn)，并聯(lián)機(jī)構(gòu)耦合之后的誤差小于各支鏈方向性的誤差，即通過(guò)耦合后，各個(gè)方向上的誤差對(duì)于動(dòng)平臺(tái)的誤差影響會(huì)降低，這也可解釋并聯(lián)機(jī)構(gòu)的精度要比串聯(lián)機(jī)構(gòu)精度高的原因。

圖4 解析法流程

圖5 數(shù)值法流程

圖6 三自由度并聯(lián)機(jī)構(gòu)x軸誤差

圖7 三自由度并聯(lián)機(jī)構(gòu)y軸誤差

圖8 三自由度并聯(lián)機(jī)構(gòu)z軸誤差

通過(guò)分析可以得出如下結(jié)論：并聯(lián)機(jī)構(gòu)經(jīng)過(guò)耦合后，機(jī)構(gòu)的結(jié)構(gòu)可以消除一部分誤差；耦合的誤差要比各個(gè)支鏈相加要小很多；耦合之后的誤差大小和各個(gè)支鏈誤差相加后并沒(méi)有明顯的聯(lián)系。

2 Stewart機(jī)構(gòu)誤差分析

Stewart機(jī)構(gòu)是并聯(lián)機(jī)構(gòu)中使用比較多且比較成熟的機(jī)構(gòu)，在第1節(jié)中利用正解的2種算法已經(jīng)證明了該方法的有效性，本節(jié)將誤差加入到Stewart機(jī)構(gòu)的正解中去，研究其誤差耦合特性。首先對(duì)機(jī)構(gòu)進(jìn)行介紹，Stewart機(jī)構(gòu)是由動(dòng)平臺(tái)、靜平臺(tái)以及連接動(dòng)靜平臺(tái)的6條支鏈構(gòu)成。按照鉸鏈形式的不同，其可以被分為6－UPS、6－SPS或是6－UCU等。本文針對(duì)6－UPS機(jī)構(gòu)進(jìn)行研究，如圖10所示。該機(jī)構(gòu)靜平臺(tái)直徑為540 mm，動(dòng)平臺(tái)直徑為480 mm，最短桿長(zhǎng)為500 mm，最長(zhǎng)為900 mm。由于Stewart機(jī)構(gòu)的位置正解是求一組六元二次方程組，求解較困難，采用數(shù)值法對(duì)其進(jìn)行求解。在z＝610，x＝20 cosα，y＝20 sinα上選取72個(gè)點(diǎn)進(jìn)行正解驗(yàn)證。其中誤差桿長(zhǎng)精度設(shè)定為0.000 001 mm。結(jié)果如圖9所示，圖中可以清晰地看出數(shù)值法對(duì)于求解Stewart機(jī)構(gòu)的有效性。

圖9 Stewart機(jī)構(gòu)正解平均誤差圖

圖10 Stewart并聯(lián)機(jī)構(gòu)坐標(biāo)系

圖10 所示為采用矢量法對(duì)其進(jìn)行誤差建模。首先在靜平臺(tái)建立根坐標(biāo)系{O}，坐標(biāo)系{O}原點(diǎn)位于靜平臺(tái)中心點(diǎn)，x軸和點(diǎn)A1呈30°夾角，z軸指向上方，通過(guò)右手定則便可以獲得y軸的方向。建立坐標(biāo)系{Oi}，其中xy平面不變，繞z軸旋轉(zhuǎn)使x軸指向靜平臺(tái)上的各個(gè)鉸點(diǎn)。規(guī)定各個(gè)鉸點(diǎn)理想坐標(biāo)為a，誤差為Δa。各個(gè)理想桿長(zhǎng)為l實(shí)際桿長(zhǎng)為Δl。動(dòng)平臺(tái)坐標(biāo)系{Op}建立，規(guī)定動(dòng)xy平面和動(dòng)平臺(tái)平面重合z軸垂直于動(dòng)平臺(tái)指向上方，x軸和點(diǎn)b呈－30°夾角。建立坐標(biāo)系{Ooi}，其中xy平面不變繞z軸旋轉(zhuǎn)使x軸指向動(dòng)平臺(tái)上的各個(gè)鉸點(diǎn)。在坐標(biāo)系O－xyz下，根據(jù)矢量鏈法建立機(jī)構(gòu)位姿閉環(huán)約束方程，如式（10）。

對(duì)式（10）進(jìn)行1階攝動(dòng)得：

對(duì)式（11）進(jìn)行分析，每條支鏈有7個(gè)誤差分別是Δaix、Δaiy、Δaiz、Δli、Δbix、Δbiy、Δaiz，總共有6條支鏈，所以誤差源總共為42個(gè)。

同三自由度并聯(lián)機(jī)構(gòu)一樣，只分析誤差耦合對(duì)于機(jī)構(gòu)動(dòng)平臺(tái)的影響，所以誤差的隨機(jī)性不在此次考慮中。規(guī)定機(jī)構(gòu)的誤差如表2所示。

表2 Stewart并聯(lián)機(jī)構(gòu)誤差值 mm

將表中的誤差代入到Stewart機(jī)構(gòu)的數(shù)值法正解中，即流程圖求解桿長(zhǎng)的方程中，繼續(xù)使用正解中的72個(gè)點(diǎn)進(jìn)行分析。結(jié)果如圖11～14所示。

圖11 Stewart機(jī)構(gòu)x軸誤差

從圖11～14可以看出，不同的單鏈經(jīng)過(guò)誤差耦合之后，動(dòng)平臺(tái)端的誤差都要比單鏈最大的誤差小，同三自由度并聯(lián)機(jī)構(gòu)一起分析，可以得出如下結(jié)論：并聯(lián)機(jī)構(gòu)經(jīng)過(guò)耦合后，機(jī)構(gòu)的結(jié)構(gòu)可以消除一部分的誤差；耦合的誤差要比各個(gè)支鏈相加要小很多；耦合之后的誤差大小和各個(gè)支鏈誤差相加后并沒(méi)有明顯的聯(lián)系。

圖12 Stewart機(jī)構(gòu)y軸誤差

圖13 Stewart機(jī)構(gòu)z軸誤差

圖14 Stewart平均誤差

3 結(jié)束語(yǔ)

本文針對(duì)一種三自由度并聯(lián)機(jī)構(gòu)，將不同的誤差代入各條支鏈模型中，從而計(jì)算出各條支鏈誤差。并聯(lián)機(jī)構(gòu)正解方法一般為解析法和數(shù)值法，本文將計(jì)算出的各條支鏈的誤差用不同的方式代入到正解中，可以得到含有誤差的末端點(diǎn)位置。對(duì)比兩種不同的帶有誤差的正解末端點(diǎn)，發(fā)現(xiàn)其基本一致，從而相互驗(yàn)證將誤差加入正解中得到各條支鏈耦合后機(jī)構(gòu)末端點(diǎn)的位置誤差。其次，分析Stewart機(jī)構(gòu)的誤差模型，并將帶有誤差的各條支鏈代入到數(shù)值法中，得到含有各條支鏈誤差耦合的Stewart末端點(diǎn)位置誤差。最后，分析了兩類(lèi)耦合后的機(jī)構(gòu)，發(fā)現(xiàn)通過(guò)耦合后，末端點(diǎn)的誤差遠(yuǎn)遠(yuǎn)小于各條支鏈的誤差和，說(shuō)明并聯(lián)機(jī)構(gòu)本身可降低各條支鏈的誤差。