郭宗和 朱松松 崔榮江 楊啟志

1.山東理工大學(xué)，淄博，255049 2.山東省農(nóng)業(yè)機(jī)械科學(xué)研究所，濟(jì)南，250100

3.江蘇大學(xué)，鎮(zhèn)江，212013

0 引言

并聯(lián)機(jī)構(gòu)因其剛度大、積累誤差小、承載能力大、動(dòng)力性能好等優(yōu)點(diǎn)而得到廣泛應(yīng)用［1］。1988年 Behi［2］首先提出了 3－PRPS 并聯(lián)機(jī)構(gòu)，Shim等［3］分析了3－PRPS并聯(lián)機(jī)構(gòu)的運(yùn)動(dòng)學(xué)反解、工作空間，Chuang等［4-5］對(duì)該機(jī)構(gòu)進(jìn)行了動(dòng)力學(xué)分析及控制規(guī)劃，拓展了該機(jī)構(gòu)運(yùn)動(dòng)學(xué)特性研究的思路，另外，王建平等［6］初步探討了該機(jī)構(gòu)的位置正解，并通過(guò)仿真分析研究了機(jī)構(gòu)參數(shù)q對(duì)機(jī)構(gòu)運(yùn)動(dòng)性能的影響。但有關(guān)該并聯(lián)機(jī)構(gòu)的位置正解還無(wú)詳細(xì)的研究報(bào)道。位置正解一直是一個(gè)挑戰(zhàn)性的問(wèn)題并且受到極大的關(guān)注。

目前并聯(lián)機(jī)構(gòu)的正解求解方法主要有數(shù)值法和封閉解法［7］。第一個(gè)被研究位置正解解析解形式的并聯(lián)機(jī)構(gòu)是 6－3型 Stewart并聯(lián)機(jī)構(gòu)。Innocenti等［8］用封閉解法分析了 6－3 型Stewart并聯(lián)機(jī)構(gòu)的位置正解。賀利樂(lè)等［9］用改進(jìn)的遺傳算法對(duì)一種混合驅(qū)動(dòng)并聯(lián)機(jī)構(gòu)的位置正解進(jìn)行了研究。

本文根據(jù)3－PRPS并聯(lián)機(jī)構(gòu)自身的結(jié)構(gòu)特點(diǎn)，通過(guò)建立約束方程，分析該并聯(lián)機(jī)構(gòu)位置正解的封閉解形式，并且采用向量之間的內(nèi)積與外積分析了機(jī)構(gòu)的位置反解，研究了該機(jī)構(gòu)在車船用減振平臺(tái)方面的應(yīng)用。

1 3－PRPS并聯(lián)機(jī)構(gòu)的結(jié)構(gòu)

3－PRPS并聯(lián)機(jī)構(gòu)如圖1所示，該并聯(lián)機(jī)構(gòu)由3個(gè)水平滑塊P1、P2、P3，3個(gè)豎直作用連桿L1、L2、L3，動(dòng)平臺(tái) B1B2B3，定平臺(tái) A1A2A3等組成，其中動(dòng)平臺(tái)和定平臺(tái)均為正三角形，且動(dòng)平臺(tái)外接圓半徑為r，定平臺(tái)內(nèi)切圓半徑為R，通過(guò)改變滑塊的位移和豎直連桿的長(zhǎng)度改變動(dòng)平臺(tái)在空間的位姿。根據(jù)3－PRPS并聯(lián)機(jī)構(gòu)的特點(diǎn)，在定平臺(tái)的重心位置O上建立定坐標(biāo)系OXYZ，在動(dòng)平臺(tái)的重心位置o上建立動(dòng)坐標(biāo)系oxyz。

圖1 3-PRPS并聯(lián)機(jī)構(gòu)簡(jiǎn)圖

2 3－PRPS并聯(lián)機(jī)構(gòu)位置正解

對(duì)于3－PRPS并聯(lián)機(jī)構(gòu)的位置正解，就是已知水平滑塊的位移Si(i=1，2，3)和豎直連桿的桿長(zhǎng) Li，求解動(dòng)平臺(tái)的位姿(XP，YP，ZP，α，β，γ)，為了方便正反解數(shù)值驗(yàn)證，現(xiàn)將位姿轉(zhuǎn)化為Bi點(diǎn)在定坐標(biāo)系中的坐標(biāo)。Bi點(diǎn)坐標(biāo)確定，動(dòng)平臺(tái)的位姿則確定。

定義θi為豎直連桿與定平臺(tái)之間的夾角，則由Pi點(diǎn)坐標(biāo)即可推導(dǎo)出 Bi點(diǎn)在定坐標(biāo)系下的坐標(biāo):

得出關(guān)于 θ1、θ2、θ3的 3 個(gè)方程:

式中，A、B、D、E、F為機(jī)構(gòu)的已知幾何參數(shù)及輸入變量的函數(shù)。

令u=tanθ1/2，v=tanθ2/2，w=tanθ3/2，利用半角公式:

將式(1)～式(3)進(jìn)一步簡(jiǎn)化為

利用Sylvester消元法，從式(5)和式(6)中消去w，得到關(guān)于u和v的4次方多項(xiàng)式，將該多項(xiàng)式寫(xiě)成v的顯式為

其中，各系數(shù)kj(j=1，2，…，5)僅是關(guān)于u的不高于4次的函數(shù)，用 v乘式(7)，用 v、v2、v3分別乘式(4)共得4個(gè)附加方程，連同式(4)、式(7)共6個(gè)方程，寫(xiě)成矩陣形式:

由于［v5v4v3v2v 1］T≠0，所以這個(gè)齊次方程組有非零解的充分必要條件是其系數(shù)行列式等于零，即

式(9)是關(guān)于u的16次代數(shù)方程，由此可解得u的值，聯(lián)立式(4)和式(7)，可解得v，最后聯(lián)立式(5)和式(6)可得到w。

u、v、w 求得后即可確定 θi，從而求得 B1、B2、B3點(diǎn)在定坐標(biāo)系下的坐標(biāo)，最終確定動(dòng)平臺(tái)的位姿。

3 3－PRPS并聯(lián)機(jī)構(gòu)位置反解

位置反解可以簡(jiǎn)單描述為:已知?jiǎng)悠脚_(tái)的位姿(XP，YP，ZP，α，β，γ)，求解水平滑塊的位移 Si和豎直連桿的桿長(zhǎng)Li，Si為正表示滑塊沿逆時(shí)針?lè)较蛞苿?dòng)，反之沿順時(shí)針?lè)较蛞苿?dòng)。

本文選擇(XYZ)RPY角坐標(biāo)表示法描述姿態(tài)旋轉(zhuǎn)矩陣，即首先將動(dòng)坐標(biāo)系繞定坐標(biāo)系的X軸旋轉(zhuǎn)γ角，再繞定坐標(biāo)系的Y軸旋轉(zhuǎn)β角，最后繞定坐標(biāo)系的Z軸旋轉(zhuǎn)α角，則兩坐標(biāo)系之間的變換矩陣為

其中，cα =cosa，sα =sinα，其他類推。為了方便運(yùn)算，用以下變量來(lái)表示矩陣中的元素，即

則有

式中，Bi為B點(diǎn)在定坐標(biāo)系中的坐標(biāo);bi為B點(diǎn)在動(dòng)坐標(biāo)系中的坐標(biāo);P為o點(diǎn)在定坐標(biāo)系中的坐標(biāo)。

在 △A1B1A2中，P1B1垂直 A1A2，所以

同理可得:

動(dòng)平臺(tái)的位姿已知時(shí)，則由以上公式可以求出3個(gè)桿長(zhǎng)Li和3個(gè)滑塊的位移Si，即求得機(jī)構(gòu)的位置反解。

4 數(shù)值驗(yàn)證

選取機(jī)構(gòu)參數(shù)如下:r=10mm，R=13mm，動(dòng)平臺(tái)初始位姿(0，0，4mm，0，0，0)，取(S1=0，S2=0，S3=0，L1=5mm，L2=5mm，L3=5mm)作為正解的輸入。

運(yùn)用MATLAB軟件編程求解，由前面正解分析可知，封閉解為一元16次方程，編程求解將會(huì)有16個(gè)解，這里由于u、v、w值不可能為復(fù)數(shù)，故舍去所有的復(fù)數(shù)解，對(duì)于上述的正解輸入，產(chǎn)生了8組實(shí)數(shù)解和8組復(fù)數(shù)解，只保留8組實(shí)數(shù)解。由8組實(shí)數(shù)解可進(jìn)一步求得Bi點(diǎn)在定坐標(biāo)系下的坐標(biāo)，求解結(jié)果如表1～表3所示。

表1 8組實(shí)數(shù)解對(duì)應(yīng)B1點(diǎn)坐標(biāo) mm

表2 8組實(shí)數(shù)解對(duì)應(yīng)B2點(diǎn)坐標(biāo) mm

表3 8組實(shí)數(shù)解對(duì)應(yīng)B3點(diǎn)坐標(biāo) mm

根據(jù)表1～表3畫(huà)出8組實(shí)數(shù)解對(duì)應(yīng)的上平臺(tái)位姿，如圖2所示。

由圖2可以看出，8組位姿是呈對(duì)稱分布的，其中，圖2h正是我們所給出的機(jī)構(gòu)的初始位姿，從而驗(yàn)證了正解求解的正確性，另外，其他圖中所示的動(dòng)平臺(tái)位姿均受到了干涉的影響，實(shí)際應(yīng)用中是不可能達(dá)到的。

取上述所得的8組實(shí)數(shù)解作為并聯(lián)機(jī)構(gòu)位置解的輸入，求解機(jī)構(gòu)位置反解，并將求解結(jié)果與正解的輸入進(jìn)行對(duì)比，求解結(jié)果如表4所示。

圖2 8組解對(duì)應(yīng)的動(dòng)平臺(tái)位姿

表4 8組實(shí)數(shù)解對(duì)應(yīng)位置反解 mm

5 應(yīng)用

由上述正解分析可知，在保證水平滑塊位移及豎直連桿桿長(zhǎng)均為初始位姿的情況下，機(jī)構(gòu)理論上只能有8個(gè)位姿，如圖2所示，但由于受干涉的影響，機(jī)構(gòu)實(shí)際上只能實(shí)現(xiàn)一種位姿，即圖2h。

這種正解唯一性的特性可以很好地應(yīng)用在減振平臺(tái)上，即動(dòng)平臺(tái)在受到來(lái)自各個(gè)方向的振動(dòng)時(shí)，能通過(guò)水平滑塊及豎直連桿移動(dòng)副處的阻尼作用，最終保證動(dòng)平臺(tái)回到初始位置，而不會(huì)因?yàn)槲恢谜獾亩嘟庑云x初始位置，減振平臺(tái)模型如圖3所示。

圖3 多維減振平臺(tái)實(shí)體模型

為了研究減振效果，在水平滑塊移動(dòng)副處添加剛度k=4.0N/mm、阻尼c=1.0N·s/mm的阻尼彈簧，在豎直連桿移動(dòng)副處添加k=4.0N/mm、c=10N·s/mm的阻尼彈簧，并且對(duì)動(dòng)平臺(tái)中心施加3個(gè)脈沖力 F和脈沖力矩 M，力的幅值為100N，力矩的幅值為100N·mm，脈沖總時(shí)間為0.4s，脈沖函數(shù)為:STEP(time，0，0，0.1，100)+STEP(time，0.1，100，0.3，－100)+STEP(time，0.3，－100，0.4，0)，進(jìn)行 End time=10，steps=100的動(dòng)力學(xué)仿真，可以得到在脈沖激勵(lì)下，動(dòng)平臺(tái)的加速度隨時(shí)間變化的曲線，如圖4所示，由曲線可以看出在同時(shí)受到脈沖力和脈沖力矩時(shí)，動(dòng)平臺(tái)的加速度有明顯的衰減，因此該機(jī)構(gòu)可以達(dá)到很好的減振效果。

圖4 動(dòng)平臺(tái)位移加速度曲線

6 結(jié)論

(1)對(duì)3－PRPS并聯(lián)機(jī)構(gòu)進(jìn)行了位置正解分析，通過(guò)建立約束方程，將含6個(gè)未知數(shù)6個(gè)方程的方程組簡(jiǎn)化為含3個(gè)未知數(shù)3個(gè)方程的方程組，減小了計(jì)算量，提高了求解速度。

(2)基于3－PRPS并聯(lián)機(jī)構(gòu)自身的結(jié)構(gòu)特點(diǎn)，通過(guò)運(yùn)用向量之間的內(nèi)積與外積，求解了機(jī)構(gòu)的位置反解，該方法簡(jiǎn)單快速，避免了大量復(fù)雜的運(yùn)算。

(3)利用數(shù)值方法對(duì)機(jī)構(gòu)的位置正反解進(jìn)行了驗(yàn)證，得出了正解的計(jì)算結(jié)果與反解的計(jì)算結(jié)果相吻合的結(jié)論，驗(yàn)證了正反解求解的正確性。

(4)研究了該機(jī)構(gòu)在車船用并聯(lián)機(jī)構(gòu)減振平臺(tái)方面的應(yīng)用，運(yùn)動(dòng)學(xué)仿真結(jié)果表明該機(jī)構(gòu)具有良好的減振性能。對(duì)位置解的分析與研究，為該機(jī)構(gòu)在車船用并聯(lián)機(jī)構(gòu)減振平臺(tái)方面的應(yīng)用奠定了堅(jiān)實(shí)的理論基礎(chǔ)。

［1］Li Yangmin，Xu Qingsong.Design，Analysis and Applications of a Class of New 3－DOF Translational Parallel Manipulators［M］.Vienna:In.Tech.Education and Publishing，2008.

［2］Behi F.Kinematics Analysis for a Six Degree of Freedom 3－PRPS Parallel Mechanism［J］.IEEE Journal of Robotics and Automation，1988，4(5):561-565.

［3］Shim J H，Kwon D S.Kinematics Analysis and Design of a Six D.O.F.3－PRPS In－parallel Manipulator［J］.Robotica，1999，17:269-281.

［4］Chuang H，Chang Y.Singularity and Workspace A-nalysis of 3－PRPS Platform Control［J］.Journal of the Chinese Society of Mechanical Engineers，2000，21(6):555-565.

［5］Chuang H，Chang Y.Fuzzy Logic Weighting Crosscoupled Control for 3－PRPS Platform［J］.Journal of the Chinese Society of Mechanical Engineers，2001，22(1):61-69.

［6］王建平，彭凱.基于ADAMS的一種新型六自由度并聯(lián)機(jī)構(gòu)的參數(shù)分析與仿真［J］.機(jī)械傳動(dòng)，2011，35(5):31-35.Wang Jianping，Peng Kai.Parameter Analysis and Simulation of a New Six－DOF Parallel Manipulator Based on ADAMS［J］.Journal of Mechanical Transmission，2011，35(5):31-35.

［7］Dasgupta B，Mruthyunjaya T S.The Stewart Platform Manipulator:a Review［J］.Mechanism and Machine Theory，2000，35:15-40.

［8］Innocenti C，Castelli V P.Direct Position Analysis of the Stewart Platform Mechanism［J］.Mechanism and Machine Theory，1990，25(6):611-621.

［9］賀利樂(lè)，劉宏昭.一種六自由度混合驅(qū)動(dòng)并聯(lián)機(jī)構(gòu)的位置正解分析研究［J］.中國(guó)機(jī)械工程，2007，18(8):920-923.He Lile，Liu Hongzhao.Research on Forward Solution of Position of 6－DOF Hybrid Driven Parallel Mechanism［J］.China Mechanical Engineering，2007，18(8):920-923.