李豪杰，張合，李珂翔，謝克峰

(1.南京理工大學(xué) 智能彈藥技術(shù)國防重點(diǎn)學(xué)科實(shí)驗(yàn)室，江蘇 南京 210094；2.中國船舶重工集團(tuán)公司 第724研究所，江蘇 南京 210003)

考慮鉸鏈間隙的水面并聯(lián)穩(wěn)定平臺動力學(xué)分析

李豪杰1，張合1，李珂翔2，謝克峰1

(1.南京理工大學(xué) 智能彈藥技術(shù)國防重點(diǎn)學(xué)科實(shí)驗(yàn)室，江蘇 南京 210094；2.中國船舶重工集團(tuán)公司 第724研究所，江蘇 南京 210003)

針對某小型浮式穩(wěn)定平臺結(jié)構(gòu)緊湊、負(fù)載慣量大的特點(diǎn)，設(shè)計了一種以少自由度并聯(lián)機(jī)構(gòu)為基礎(chǔ)的改進(jìn)型串聯(lián)與并聯(lián)機(jī)構(gòu)。根據(jù)該平臺的結(jié)構(gòu)特點(diǎn)，進(jìn)行了運(yùn)動學(xué)分析，推導(dǎo)了系統(tǒng)雅可比矩陣，并利用Lagrange方法建立了平臺的動力學(xué)模型，分析了平臺的動力學(xué)特性。為分析含間隙的支鏈?zhǔn)芰?，將其簡化為剛體—彈簧模型，通過改進(jìn)的Hertz接觸理論，采用非線性彈簧阻尼模型計算接觸力，最終建立了含鉸鏈間隙的平臺動力學(xué)模型。數(shù)值計算與實(shí)驗(yàn)結(jié)果表明了數(shù)據(jù)建模的有效性，同時鉸鏈間隙對動平臺的位置精度和動力學(xué)特性產(chǎn)生了顯著影響，對平臺結(jié)構(gòu)產(chǎn)生了較強(qiáng)的沖擊。

機(jī)械學(xué)；并聯(lián)機(jī)構(gòu)；穩(wěn)定平臺；鉸鏈間隙；動力學(xué)分析

0 引言

工作于水面的小型無人浮式穩(wěn)定平臺，搭載有光電探測設(shè)備，因其體積較小、運(yùn)輸方便等優(yōu)點(diǎn)，在海洋區(qū)域偵察等方面具有重要的應(yīng)用價值。平臺性能的優(yōu)劣決定了探測設(shè)備能否正常工作，作為負(fù)載的探測設(shè)備質(zhì)量較重，波浪繞動大，平臺尺寸有限制，這些特點(diǎn)決定了平臺的結(jié)構(gòu)形式必須具有剛度大，承載能力強(qiáng)，動態(tài)性能好等特性[1]。并聯(lián)機(jī)構(gòu)具有上述優(yōu)點(diǎn)，因而在運(yùn)動平臺領(lǐng)域得到了廣泛應(yīng)用。通常并聯(lián)機(jī)構(gòu)的設(shè)計指標(biāo)主要為滿足大負(fù)載和高剛度等要求，故多采用電動缸，驅(qū)動能力有限，空間占用大，并且會帶來額外負(fù)載，因此不適用于本文的穩(wěn)定平臺[2-4]。本文提出一種新型穩(wěn)定平臺，其特點(diǎn)是將滾珠絲桿和大功率電機(jī)固定，采用固定長度的支撐桿連接動平臺，從而具有空間利用率高和負(fù)載能力強(qiáng)等優(yōu)點(diǎn)。

由于該平臺的使用環(huán)境與結(jié)構(gòu)特點(diǎn)，機(jī)構(gòu)中的鉸鏈在工作一段時間后，不可避免地會出現(xiàn)間隙，另外加工裝配工藝也決定了間隙存在的必然性。相關(guān)文獻(xiàn)已驗(yàn)證，間隙會導(dǎo)致整個系統(tǒng)的動力學(xué)特性存在非線性[5-6]，尤其是當(dāng)鉸鏈內(nèi)部在接觸和分離兩種運(yùn)動模式之間轉(zhuǎn)換時，會產(chǎn)生強(qiáng)烈碰撞。因此很有必要研究運(yùn)動副含間隙的并聯(lián)機(jī)構(gòu)。目前，含間隙連桿機(jī)構(gòu)的研究已取得了較多成果，而含間隙并聯(lián)機(jī)器人的研究仍然很少。Shiau等[7]研究了一種含間隙柔性并聯(lián)機(jī)構(gòu)的非線性動力學(xué)特性；Flores等[8]研究了柱鉸對多體系統(tǒng)的影響，建立了平面間隙鉸模型。

本文對穩(wěn)定平臺進(jìn)行運(yùn)動學(xué)分析，得到系統(tǒng)雅可比矩陣；利用Lagrange方法，建立平臺的完整動力學(xué)模型，通過數(shù)值計算得到動力學(xué)曲線；以支鏈間隙為研究對象，利用剛體—彈簧模型簡化支鏈，采用改進(jìn)的Hertz接觸理論、非線性彈簧阻尼模型計算含間隙鉸鏈的接觸力，得到含間隙平臺動力學(xué)方程，并結(jié)合實(shí)驗(yàn)分析間隙對動力學(xué)特性的影響。所得結(jié)論可為此類平臺的控制應(yīng)用提供理論參考。

1 穩(wěn)定平臺的結(jié)構(gòu)

1.1 結(jié)構(gòu)與自由度

如圖1所示為設(shè)計的穩(wěn)定平臺結(jié)構(gòu)原理示意圖，其主要構(gòu)成為動平臺、三自由度球鉸鏈、支撐桿、二自由度虎克鉸、絲桿螺帽和滾珠絲桿、基座等部件。動平臺靠3個支點(diǎn)A1、A2、O分別與平臺的基座和傳動支鏈相連接，并構(gòu)成以O(shè)點(diǎn)為直角的等腰直角三角形A1A2O.

圖1 穩(wěn)定平臺原理Fig.1 Schematic diagram of the platform

傳動支鏈由一套滾珠絲桿套件、一個虎克鉸鏈、一個支撐桿和一個球鉸鏈構(gòu)成。其中，滾珠絲桿固定于基座，只有一個繞其自身回轉(zhuǎn)軸的旋轉(zhuǎn)自由度；絲桿螺帽只有一個沿著絲桿上下移動的平移自由度，該運(yùn)動受控于滾珠絲桿的旋轉(zhuǎn)運(yùn)動。球鉸鏈和虎克鉸鏈的幾何中心與滾珠絲桿回轉(zhuǎn)軸重合；當(dāng)動平臺與基座兩個平面平行時，此3個部件的連線垂直于動平臺平面。動平臺受O點(diǎn)處的虎克鉸鏈制約，只可作兩個自由度的旋轉(zhuǎn)運(yùn)動。

1.2 坐標(biāo)系建立

坐標(biāo)系的建立如圖1所示，具體如下：

平臺基座坐標(biāo)系{Cb}：該坐標(biāo)系固定在穩(wěn)定平臺的下平臺基座上，原點(diǎn)O位于直角三角形A1A2O的直角，{Cb}坐標(biāo)軸Xb、Yb、Zb分別與基座的橫軸、縱軸、垂直軸相互平行，其中Zb與基座的垂直軸重合。繞Xb、Yb、Zb3軸的轉(zhuǎn)角分別為θ、φ、ψ. 下文未說明的坐標(biāo)變換均基于平臺基座坐標(biāo)系。

動平臺坐標(biāo)系{Cm}：該坐標(biāo)系固定在穩(wěn)定跟蹤平臺的動平臺上，原點(diǎn)Om外與{Cb}坐標(biāo)系的原點(diǎn)O重合，當(dāng)動平臺處于平衡位姿時，{Cm}坐標(biāo)軸(Xm，Ym，Zm)與{Cb}坐標(biāo)軸(Xb，Yb，Zb)平行。

2 穩(wěn)定平臺的動力學(xué)建模

采用Lagrange方法建立整個穩(wěn)定平臺的動力學(xué)模型。Lagrange方程可表示為

(1)

2.1 動平臺的動能與勢能

動平臺只有轉(zhuǎn)動自由度，沒有平移自由度，剛體的轉(zhuǎn)動動能為剛體的動量矩與角速度點(diǎn)積的一半，則轉(zhuǎn)動動能的矩陣形式為

(2)

式中：mωm代表動平臺基于空間角速度矢量，將其轉(zhuǎn)換為歐拉角空間坐標(biāo)系，轉(zhuǎn)換矩陣為REuler；mIm代表動平臺在其自身坐標(biāo)系中相對慣性主軸的慣量矩陣。

將局部空間向量替換成廣義坐標(biāo)，動能方程可表示為

(3)

2.2 支撐桿及絲桿螺帽的動能與勢能

傳動支鏈的動能包括絲桿螺帽、支撐桿的平動動能和轉(zhuǎn)動動能；勢能包括兩者在平臺基座坐標(biāo)系Z軸方向的勢能。把支撐桿簡化為直桿，絲桿螺帽和支撐桿質(zhì)量分別為mz、ms，其質(zhì)心在動平臺與基座保持平行時距動平臺球鉸鏈Ai的距離分別為d2、d1.

(4)

式中：

JVA=ROA·REuler,

(5)

ROA表示動平臺上的球鉸鏈Ai相對于動平臺坐標(biāo)系的位置向量，REuler表示歐拉轉(zhuǎn)換坐標(biāo)系；JInv為系統(tǒng)的雅可比矩陣。

支撐桿的轉(zhuǎn)動動能為

(6)

式中：bIms為支撐桿在其自身坐標(biāo)系中的轉(zhuǎn)動慣量矩陣；L為連桿長度。

支撐桿的平動動能為

(7)

支撐桿的勢能為

Vms=msg[1 1]·bPmsZ，

(8)

式中：bPmsZ=[bPms1Z，bPms2Z]T為所有支撐桿在平臺基座坐標(biāo)系中Z軸的坐標(biāo)。

絲桿螺帽的動能為

(9)

絲桿螺帽的勢能為

Vmz=mzg[1 1]·bPmzZ,

(10)

式中：bPmzZ=[bPmz1Z，bPmz2Z]T為所有絲桿螺帽在平臺基座坐標(biāo)系中Z軸的坐標(biāo).

2.3 動力學(xué)方程

綜合以上各式，則有理想約束平臺動力學(xué)方程為

(11)

3 含間隙傳動支鏈建模

3.1 廣義力分析

圖2為含間隙傳動支鏈?zhǔn)芰δＰ褪疽鈭D，CiDi為支撐桿，AiCi為球鉸鏈，BiDi為虎克鉸，后二者間存在鉸鏈間隙。由于含間隙鉸鏈?zhǔn)侵ф湹谋∪醐h(huán)節(jié)，所以在受力分析時，將支撐桿看作剛體，鉸鏈簡化為彈簧。由于間隙相對于平臺仍是極小量，所以假設(shè)間隙不改變支鏈的宏觀位姿關(guān)系。fCi與fDi為施加于支撐桿兩端的鉸鏈接觸反力。根據(jù)力與力矩平衡原理可得

fCi+fDi+m1g=m1amsi,

(12)

d1LifCi+(d1-L)LifDi+Msi=bImsiαmsi,

(13)

式中：asi為支撐桿質(zhì)心的加速度；αsi為支撐桿的角加速度；Msi為虎克鉸Bi限制支撐桿軸向旋轉(zhuǎn)的力矩。對于鉸鏈接觸力有

fCi=ks(Ai-Ci)+cs(VAi-VCi),

(14)

fDi=kr(Bi-Di)+cr(VBi-VDi),

(15)

式中：ks、cs為球鉸的剛度、阻尼系數(shù)；kr、cr為虎克鉸的剛度、阻尼系數(shù)。對于動平臺有

(16)

圖2 含間隙傳動支鏈?zhǔn)芰κ疽鈭DFig.2 Force diagram of chain with clearance joints

3.2 含間隙球鉸的數(shù)學(xué)模型

根據(jù)實(shí)驗(yàn)測得，球鉸間隙在支鏈中最大，以其為例分析。如圖3所示，α和β分別代表球窩、球頭，其半徑分別為Rα、Rβ. 球鉸間隙定義為c=Rα-Rβ，Pα(Ci)、Pβ(Ai)分別為球窩、球頭的中心，球窩、球頭中心分別在自身坐標(biāo)系中的矢徑為rPα、rPβ.

圖3 含間隙球鉸示意圖Fig.3 Schematic diagram of spherical joint with clearance

則其在基座坐標(biāo)系中的矢徑為

(17)

(18)

球窩與球頭接觸的幾何條件則可定義為

δi=ei-c=|AiCi|-c.

(19)

含間隙球鉸的運(yùn)動狀態(tài)分為自由運(yùn)動和接觸變形，在運(yùn)動過程中存在能量損耗，不能用完全彈性碰撞建模；采用Machado等[9]擴(kuò)展后的Hertz接觸模型，使用非線性彈簧阻尼模型描述接觸力，其中法向接觸力為

(20)

(21)

(22)

根據(jù)Coulumb摩擦模型[10]，切向接觸力為

FiT=-μsFiNviT/|viT|,

(23)

式中：viT為接觸點(diǎn)相對滑動線速度；μs為動摩擦系數(shù)。則球鉸接觸力合力為

fCi=FiN+FiT.

(24)

3.3 含間隙動力學(xué)模型

含間隙鉸鏈在分離狀態(tài)和接觸變形狀態(tài)之間轉(zhuǎn)換，可用(24)式導(dǎo)出的非線性彈簧阻尼力代替鉸鏈約束力，則系統(tǒng)的非線性動力學(xué)方程[8]為

(25)

式中：M為廣義質(zhì)量矩陣；Q為廣義力；Φ(q,t)=0為理想鉸鏈約束方程；Φq為約束方程的雅可比矩陣；λ為拉格朗日乘子；Fc=[fC1，fC2]T為接觸力相對廣義坐標(biāo)q的廣義接觸力，包括法向接觸力和切向接觸力，當(dāng)鉸鏈處于分離狀態(tài)時，F(xiàn)c=0.

4 仿真分析與實(shí)驗(yàn)

為了驗(yàn)證平臺設(shè)計是否滿足要求，研究平臺的動力學(xué)特性與鉸鏈間隙的影響，給定動平臺在垂直面內(nèi)的激勵力為80sin (20πt) N·m. 算例采用Newmark算法進(jìn)行計算，根據(jù)(25)式，計算得到了動平臺受間隙影響的位移曲線，以及鉸鏈接觸力的變化曲線，如圖4、圖5所示。

圖4 含間隙平臺φ角位移曲線Fig.4 Displacement curves of angle φ of platform with clearance joints

圖5 球鉸B2接觸力曲線Fig.5 Contact force curves of spherical joint B2

由圖4可知，在計入球鉸間隙后，動平臺的擺動幅度增大了10%左右，在峰值附近存在了多個緊靠的尖峰，說明球鉸內(nèi)部發(fā)生了連續(xù)的碰撞，快速地在接觸變形和自由運(yùn)動狀態(tài)之間轉(zhuǎn)換。根據(jù)圖5可知，球鉸接觸力峰值非常大，在沒有考慮間隙時，接觸力是一條平滑的曲線，計入球鉸間隙后是理想接觸時的40倍；峰值相對集中，說明球鉸內(nèi)部存在有規(guī)律的碰撞，這也印證了圖5的多次連續(xù)碰撞現(xiàn)象；峰值集中的區(qū)域即為平臺換向的時刻，對于平臺的穩(wěn)定調(diào)平控制，需要頻繁地在平衡位置附近換向，間隙的存在無疑給系統(tǒng)增加了遲滯環(huán)節(jié)，放大了誤差，這種影響也體現(xiàn)在了樣機(jī)調(diào)試實(shí)驗(yàn)中。

完成的平臺原理樣機(jī)如圖6所示，支撐桿兩端的球鉸和虎克鉸隨著使用時間的增長，在原有小間隙的基礎(chǔ)上不斷變大，對系統(tǒng)產(chǎn)生的影響也會越來越大，樣機(jī)中的球鉸分別為使用3個月后具有一定間隙的狀態(tài)和減小間隙改進(jìn)后的全新狀態(tài)。

圖6 穩(wěn)定平臺樣機(jī)Fig.6 Experimental platform prototype

在測試時，并聯(lián)穩(wěn)定平臺驅(qū)動電機(jī)位置鎖死，負(fù)載設(shè)備在OXZ平面內(nèi)快速運(yùn)動，對動平臺施加激勵力，并采用高帶寬的慣性姿態(tài)參考模塊測量動平臺的角度，鉸鏈間隙的受力較難通過壓力測出，因此采用角度測量進(jìn)行間接說明。圖7(a)為使用后球鉸角位移實(shí)驗(yàn)值與仿真數(shù)據(jù)對比曲線，圖7(b)為采用改進(jìn)的小間隙鉸鏈與原有使用磨損一段時間的鉸鏈進(jìn)行對比的角位移實(shí)驗(yàn)曲線。對動平臺角位移進(jìn)行了6次測量，測試數(shù)據(jù)見表1.

由圖7(a)可知，實(shí)驗(yàn)數(shù)據(jù)與仿真結(jié)果具有較好的一致性，說明了數(shù)據(jù)建模的有效性，由圖7(b)可知，經(jīng)過球鉸間隙的影響，動平臺的角位移被放大，其誤差幅度由表1可知最大誤差為30.4%，可知因間隙導(dǎo)致的沖擊使得相關(guān)機(jī)構(gòu)產(chǎn)生了更大的彈性變形，從而使誤差進(jìn)一步放大。通過球鉸改進(jìn)，動平臺的角位移保持在0.15°內(nèi)，能在一定程度上減小球鉸間隙的影響。

表1 使用后狀態(tài)與改進(jìn)后狀態(tài)鉸鏈下的平臺角位移誤差Tab.1 Angular displacement errors of platform with used and improved hinges

圖7 動平臺搖擺模擬實(shí)驗(yàn)角位移對比曲線Fig.7 Simulated and experimental angular displacements of platform

5 結(jié)論

本文針對某小型浮式穩(wěn)定平臺的需求，設(shè)計了一種以少自由度并聯(lián)機(jī)構(gòu)為基礎(chǔ)的改進(jìn)型串并聯(lián)機(jī)構(gòu)。對該平臺進(jìn)行了運(yùn)動學(xué)分析，推導(dǎo)了系統(tǒng)雅可比矩陣，建立了動力學(xué)模型。通過將支鏈簡化為剛體—彈簧模型，建立了含鉸鏈間隙的平臺動力學(xué)模型。數(shù)值計算與實(shí)驗(yàn)結(jié)果表明：數(shù)據(jù)建模與實(shí)驗(yàn)結(jié)果具有較好的一致性，說明了數(shù)據(jù)建模的有效性；間隙會導(dǎo)致動平臺在換向時出現(xiàn)約為30.4%的位移誤差，此時由于鉸鏈在自由運(yùn)動與接觸變形之間反復(fù)轉(zhuǎn)換狀態(tài)，產(chǎn)生了最大值比理想接觸力峰值高40倍的接觸力，給系統(tǒng)帶來了強(qiáng)烈的非線性擾動。在已知這些結(jié)果后，通過結(jié)構(gòu)抑制和算法補(bǔ)償是修正此類擾動的有效途徑。所得結(jié)論可為該類平臺的高精度控制與結(jié)構(gòu)優(yōu)化設(shè)計提供理論依據(jù)。

References)

[1] 陰蕊，房建成，鐘麥英. 航空遙感用三軸慣性穩(wěn)定平臺動力學(xué)建模與仿真[J]. 中國慣性技術(shù)學(xué)報，2011，19(6)：676-680，685. YIN Rui, FANG Jian-cheng, ZHONG Mai-ying. Dynamic modeling and simulation of inertial stabilized platform for aerial remote sensing system[J]. Journal of Chinese Inertial Technology, 2011, 19(6): 676-680,685. (in Chinese)

[2] Zhang Y B, Liu H Z, Wu X. Kinematics analysis of a novel parallel manipulator[J]. Mechanism and Machine Theory, 2009, 44(9)：1648-1657.

[3] 牛雪梅，高國琴，劉辛軍，等. 新型驅(qū)動冗余并聯(lián)機(jī)構(gòu)動力學(xué)建模及簡化分析[J]. 機(jī)械工程學(xué)報，2014，50(19)：41-49. NIU Xue-mei, GAO Guo-qin, LIU Xin-jun, et al. Dynamic formulation and simplified model of a novel 3-DOF parallel mechanism with actuation redundancy [J]. Journal of Mechanical Engineering, 2014, 50(19): 41-49. (in Chinese)

[4] 滿益明，陳慧巖，胡玉文，等. 智能車輛捷聯(lián)視線穩(wěn)定跟蹤平臺設(shè)計與實(shí)現(xiàn)[J]. 中國慣性技術(shù)學(xué)報，2009，17(4)：397-402. MAN Yi-ming, CHEN Hui-yan, HU Yu-wen, et al. Design and implementation of intelligent vehicle strapdown line-of-sight stabilization pointing platform system [J]. Journal of Chinese Inertial Technology, 2009, 17(4): 397-402. (in Chinese)

[5] Zhang X C, Zhang X M. A comparative study of planar 3-RRR and 4-RRR mechanisms with joint clearances [J]. Robotics and Computer-Integrated Manufacturing, 2016, 40：24-33.

[6] Ma J, Qian L F, Chen G S, et al. Dynamic analysis of mechanical systems with planar revolute joints with clearance [J]. Mechanism and Machine Theory, 2015, 94: 148-164.

[7] Shiau T N, Tsai Y J, Tsai M S. Nonlinear dynamic analysis of a parallel mechanism with consideration of joint effects [J]. Mechanism and Machine Theory, 2008, 43(4): 491-505.

[8] Flores P, Ambrosio J. Revolute joints with clearance in multibody systems[J]. Computers and Structures, 2004, 82(17/18/19): 1359-1369.

[9] Machado M, Moreira P, Flores P, et al. Compliant contact force models in multibody dynamics: evolution of the Hertz contact theory [J]. Mechanism and Machine Theory, 2012, 53: 99-121.

[10] Flores P, Ambrósio Ambrosio J, Claro J C P, et al. A study on dynamics of mechanical systems including joints with clearance and lubrication [J]. Mechanism and Machine Theory, 2006, 41(3): 247-261.

Dynamic Analysis of Offshore Parallel Stabilized Platform in Considering Joint Clearance

LI Hao-jie1, ZHANG He1, LI Ke-xiang2, XIE Ke-feng1

(1.Ministerial Key Laboratory of ZNDY, Nanjing University of Science and Technology, Nanjing 210094, Jiangsu, China；2.No.724 Research Institute, China Shipbuilding Industry Corporation, Nanjing 210003, Jiangsu, China)

An improved serial-parallel mechanism based on less DOF parallel mechanism is designed for a floating stabilized platform with compact structure and high load inertia. Based on the structural characteristics of the platform, the kinematics is analyzed, the system Jacobian matrix is derived, and a dynamic model is established and analyzed by using Lagrange equation. A simplified rigid body-spring model is proposed to analyze the chains with clearance joints. A non-linear spring-damper model is introduced to calculate the contact force by using improved Hertz contact theory, and a dynamic model considering joint clearance is established. The numerically computated and experimental results show that the dynamic model is effective, and the clearance has significant impact on the structure,position accuracy and dynamic characteristics of moving platform.

mechanics; parallel mechanism; stabilized platform; joint clearance; dynamic analysis

2016-04-07

國家自然科學(xué)基金項(xiàng)目(51475243)

李豪杰(1973—)，男，副教授，碩士生導(dǎo)師。E-mail:haojieli@njust.edu.cn

TP242.3

A

1000-1093(2017)01-0129-06

10.3969/j.issn.1000-1093.2017.01.017