李 林,丁 健,孟慶平,王興澤,王秀麗,裴 旭,吳躍民
(1.北京空間飛行器總體設(shè)計部,北京100094;2.北京航空航天大學(xué)機械工程及自動化學(xué)院,北京100191)
太陽電池陣是飛船電源系統(tǒng)中的重要組成部分,在飛船飛行過程中需要依據(jù)其姿態(tài)和軌道進行角度調(diào)整,實現(xiàn)太陽光線與飛船太陽電池陣的最佳夾角,最大限度發(fā)揮太陽電池陣的效能[1]。目前飛船上太陽電池陣一般為單軸旋轉(zhuǎn)[2],優(yōu)點是結(jié)構(gòu)簡單,但由于自身運動空間的限制,太陽光線不能始終與太陽電池陣垂直,不能完全實現(xiàn)光照效率最大化,同時更大面積的太陽電池陣帶來更大的慣量負載,對飛船快速變軌調(diào)整有不利影響。太陽電池陣指向機構(gòu)若具備3個自由度,即可滿足其在軌的各種工作姿態(tài)需求。并聯(lián)機構(gòu)定位精度高、剛度大、結(jié)構(gòu)穩(wěn)定、承載能力強、運動慣量小、可冗余工作,在空間領(lǐng)域得到了越來越多的應(yīng)用。
目前國際上綜合性能較好的3自由度并聯(lián)機構(gòu)較少,CLAVEL[3]將4S平行四邊形機構(gòu)用于并聯(lián)機構(gòu)支鏈,設(shè)計出著名的3自由度移動機構(gòu)DELTA;TSAI[4]等提出 3 自由度移動并聯(lián)機構(gòu),支鏈用到了4R平行四邊形機構(gòu)。這類機構(gòu)都可以歸于含有閉環(huán)子鏈的并聯(lián)機構(gòu),但組成復(fù)雜,運動學(xué)逆解較難,指向范圍及工作空間較小,無法滿足飛船太陽電池陣指向的大范圍需求。NASA設(shè)計了一種新型并聯(lián)機構(gòu),用于CEV反推發(fā)動機的指向與驅(qū)動,同時也可用于太陽電池陣指向裝置,因為轉(zhuǎn)動副采用銷軸式方案,零部件采用異形連桿形式,存在加工難度大、運動精度差等缺點,且并未對其工作空間、運動學(xué)正逆解、冗余特性等進入深入研究[5]。法國國家空間研究中心研制了一種3自由度并聯(lián)天線指向機構(gòu),用于空間高速數(shù)據(jù)傳輸探索項目,天線工作在X波段,目前已完成力學(xué)試驗進入工程化階段,由于機構(gòu)構(gòu)型原因,機構(gòu)工作空間較?。?]。
本文提出一種具有3個自由度、采用模塊化對稱設(shè)計的新型并聯(lián)式太陽電池陣指向機構(gòu)方案,以滿足太陽電池陣大范圍指向需求,實現(xiàn)太陽電池陣光照效率的最大化,同時減小太陽電池陣慣性負載對飛船軌道機動的影響,豐富飛船太陽電池陣指向機構(gòu)的選擇型譜。
目前飛船太陽電池陣一般為單軸旋轉(zhuǎn)[2],其運動范圍受限于自身運動空間,要想實現(xiàn)光照效率最大化,就需要使太陽光線與太陽電池陣盡量垂直,一方面可以有效減少太陽電池陣面積需求,另一方面還可以隨時調(diào)整太陽電池陣姿態(tài)以適應(yīng)飛船各種任務(wù)需求。并聯(lián)式太陽電池陣指向機構(gòu)在設(shè)計時,需要重點考慮機械接口、電接口、控制接口等眾多設(shè)計因素,本文在進行方案設(shè)計時,與相關(guān)設(shè)計部門對接了初步接口需求約束。
太陽電池陣在飛船上的姿態(tài)變化如圖1所示,通過并聯(lián)指向機構(gòu)實現(xiàn)與飛船服務(wù)艙的連接,根據(jù)飛船的姿態(tài)及軌道需求,通過太陽敏感器確定最佳指向參數(shù),通過反解計算實現(xiàn)太陽電池陣的實時對日指向調(diào)整。
圖1 太陽電池陣工作指向示意圖Fig.1 Work diagram of the spacecraft solar array
并聯(lián)指向機構(gòu)的詳細組成如圖2所示,主要由定平臺、動平臺以及連接定動平臺且均勻分布的3條支鏈組成一個閉環(huán)系統(tǒng)。其中3條支鏈采用模塊化設(shè)計思想,采用完全相同的設(shè)計形式,包括兩個短連桿、兩個長連桿、連接各運動鏈的5個轉(zhuǎn)動副。每個支鏈都通過單獨的驅(qū)動組件驅(qū)動,驅(qū)動組件固定在基座上,其末端安裝有高精度旋轉(zhuǎn)編碼器,用于輸出角度的精確測量,通過三個驅(qū)動組件的運算配合,可實現(xiàn)動平臺的大范圍指向。動平臺為太陽電池陣提供安裝接口。旋繞式柔性電纜用于太陽電池陣電功率及電信號的傳輸,根據(jù)動平臺的位置姿態(tài)自適應(yīng)調(diào)整。
圖2 并聯(lián)式太陽電池陣指向機構(gòu)Fig.2 Parallel pointing mechanism of the spacecraft solar array
并聯(lián)指向機構(gòu)由一個動平臺Q1Q2Q3、三條支鏈PiGiQi(i=1~3)和一個定平臺 P1P2P3組成,兩平臺均為等邊三角形,是一個典型的規(guī)則對稱結(jié)構(gòu)。整個機構(gòu)由3條支鏈組成,每一個支鏈都有獨立的驅(qū)動源,通過驅(qū)動源之間的運動算法,實現(xiàn)并聯(lián)機構(gòu)的大范圍運動,運動過程中,機構(gòu)相對平面ΔG1G2G3對稱。
為了便于分析該并聯(lián)機構(gòu)的運動學(xué)正逆解,建立坐標系,如圖3所示。定坐標系O-xyz及動坐標系C-uvw,原點O、C在兩平臺幾何中心,x軸與矢量OP1重合,u軸與矢量CQ1重合。Pi-xiyizi(i=1~3)固接在驅(qū)動關(guān)節(jié)上,坐標系Qi-uiviwi(i=1~3)固接在被動關(guān)節(jié)上。 用 βi(i=1~3)表示主動桿的輸入角,用 αi(i=1~3)表示矢量CQi與QiGi的夾角(即輸出角)。設(shè)動平臺 CQi= r(i=1~3),定平臺 OPi= R (i=1~3),主動桿長度 PiGi= L1(i=1~3),被動桿長度QiGi= L2(i=1 ~3),進行正、逆解計算[7]。
圖3 并聯(lián)指向機構(gòu)坐標系Fig.3 The coordinate system of parallel pointing mechanism
每個支鏈由5個轉(zhuǎn)動副組成,如圖4所示。其中轉(zhuǎn)動副2、3、4等效為一個球副(S副),由Kutzbach Grubler公式[8]來表示該機構(gòu)的自由度,如式(1):
式中,F(xiàn)為機構(gòu)的自由度;n為構(gòu)件數(shù);g為運動副數(shù);fi為第i個運動副的相對自由度數(shù)。
由圖4可知,機構(gòu)中因為每個支鏈中有4個構(gòu)件,則3條支鏈共12個構(gòu)件,另外動、定平臺共2個,因此機構(gòu)共14個構(gòu)件,所以n=14。機構(gòu)中有15個自由度為1的轉(zhuǎn)動副,該機構(gòu)無虛約束、局部自由度及復(fù)合鉸鏈等特殊情況,所以g=15。代入式(1)中,則有F =3。
圖4 單支鏈運動簡圖Fig.4 Single chain diagram of parallel pointing mechanism
根據(jù)飛船太陽敏感器可得出實現(xiàn)最大光照效能的太陽電池陣目標位置,即得出動平臺的目標位姿,反求并聯(lián)指向機構(gòu)的輸入角度βi,即求出其運動學(xué)逆解,作為驅(qū)動組件的輸出角度。
設(shè)獨立變量為Xi= [Xc,Yc,Zc]T,φi為坐標系Pi-xiyizi相對定坐標系O-xyz的方位角,如式(2):
設(shè)oTPi表示坐標系Pi-xiyizi到定坐標系O-xyz的變換矩陣,如式(3):
設(shè)PiGi表示Gi點在坐標系Pi-xiyizi的坐標,如式(4):
點Gi在定坐標系的坐標通過式(5)求得:
矢量OC被中間平面ΔG1G2G3平分且垂直于中間平面,設(shè)M點表示矢量OC與中間平面ΔG1G2G3的交點,如式(6):
其中:M =OM,C =OC。
約束條件如式(7):
將式(5)和式(6)代入式(7)展開,可得到式(8) ~(11):
通過式(8)~(11),可求得并聯(lián)指向機構(gòu)的封閉逆解,即若給出工作空間 [ Xc,Yc,Zc]T, 即可得到驅(qū)動組件的輸入角βi,每個βi都有兩組值,因此有8組逆解,但8組逆解并非都適合并聯(lián)機構(gòu)的運行需求,還需對8組逆解進行篩選,確定其唯一性,以便控制系統(tǒng)方便實現(xiàn)驅(qū)動組件目標角度的輸出。
并聯(lián)機構(gòu)的運動學(xué)正解一般較其逆解要困難得多,特別是當運動鏈增加時,并聯(lián)機構(gòu)的運動學(xué)正解很難得到封閉解,這往往會給并聯(lián)機構(gòu)的進一步研究帶來困難[9]。但本文研究的空間3自由度并聯(lián)指向機構(gòu)關(guān)于面ΔG1G2G3規(guī)則對稱,其正解較為簡單。
若已知輸入角度βi,則輸出角度αi=180oβi(i= 1~3),其正解唯一,根據(jù)逆解可知,假設(shè)點 M = [xm,ym,zm]T, 則 M 點滿足式(12):
其中,由公式(5)可計算出Gi,解該方程即可求出M點坐標,故C點坐標根據(jù)C=2 M =[2xm,2ym,2zm]T解出,得到正解。
并聯(lián)結(jié)構(gòu)的工作空間可分為可達工作空間和靈活工作空間[10-11]。對于空間并聯(lián)機構(gòu)來說,由于受其結(jié)構(gòu)的限制,平臺一般不能繞某一點轉(zhuǎn)動360°,所以一般沒有靈活工作空間,因此本文研究的工作空間指的是可達工作空間。
并聯(lián)機構(gòu)的工作空間受到主、被動桿的運動范圍和連桿尺寸、結(jié)構(gòu)等因素的限制,運用極限邊界搜索方法[12]來計算工作空間較為方便。極限邊界搜索方法是基于并聯(lián)機構(gòu)的運動學(xué)位置逆解而進行的一種搜索方法,即給出一個包含并聯(lián)機構(gòu)所有可能工作空間的范圍,在此范圍內(nèi),產(chǎn)生大量隨機的點,每一點被測試是否在工作空間內(nèi),逐點求每一條支鏈的逆解,如果是實數(shù)解,該點就在工作空間內(nèi),否則在工作空間之外。若能將所有的滿足約束條件的點搜索出來,那么由這些點所組成曲面構(gòu)成了并聯(lián)機構(gòu)的工作空間。
本文使用MATLAB語言實現(xiàn)該算法,完成工作空間的搜索及可視化。經(jīng)過優(yōu)化設(shè)計,并聯(lián)機構(gòu)的結(jié)構(gòu)尺寸R=r=84 mm,L1=L2=84 mm。 輸入角度βi的變化范圍為20°~180°,高度z變化范圍為128 mm~328 mm。得到的工作空間如圖5及圖6所示,圖中所示顏色即代表其數(shù)值大小,深藍色數(shù)值最小,深紅色數(shù)值最大。
圖5 工作空間仿真圖(三維)Fig.5 The 3D workspace of pointing parallel mechanism
圖6 工作空間仿真圖(俯視)Fig.6 The top view of workspace of pointing parallel mechanism
為驗證正解、逆解的正確性,使用ADAMS進行運動學(xué)仿真。動平臺C點的位置為目標位置,利用運動學(xué)逆解可求出三個輸入角βi,每個βi都有兩組值,通過組合可以得出8組逆解。由于并聯(lián)指向機構(gòu)中心安裝有旋繞式柔性電纜,并聯(lián)機構(gòu)的3個支鏈運動不能與其產(chǎn)生干涉,因此必須對8組逆解進行篩選,確定其唯一性,以便控制系統(tǒng)方便實現(xiàn)驅(qū)動組件目標角度的輸出。
為了尋找逆解的篩選規(guī)則,同時驗證運動學(xué)逆解的正確性及精確性,建立基于ADAMS的虛擬樣機,取虛擬樣機的結(jié)構(gòu)參數(shù)R=r=84 mm,L1=L2=84 mm,如圖7所示。
圖7 虛擬樣機模型Fig.7 The virtual model for simulation
取動平臺 C點的位置 xc=10 mm,yc=20 mm,zc=164 mm,在MATLAB中使用極限邊界搜索法進行運行學(xué)逆解,計算出三個輸入角βi:
對其8組逆解組合分別進行了仿真分析,本文列舉了其中兩組,其在ADAMS中的仿真狀態(tài)如圖8所示。
圖8 虛擬樣機運動學(xué)仿真Fig.8 The kinematics simulation of virtual model
由圖8可知,第2組解得虛擬樣機中有一個運動支鏈已明顯進入旋繞式柔性電纜的區(qū)域內(nèi),存在干涉現(xiàn)象,其余的6組解同樣存在該現(xiàn)象。通過對多組目標位置求解及仿真,只有當取輸入角βi中兩個解的最大值進行組合時,才能滿足工程實現(xiàn)的需求,控制系統(tǒng)以此唯一逆解組合作為輸出量。
把第1組逆解作為虛擬樣機的輸入角度,利用正解方法求動平臺點C的位置,結(jié)果如圖9所示。 圖中,xc=9.9999 mm,yc=20.0000 mm,zc=163.9999 mm。上述值與初始的目標位置誤差較小,正解與逆解結(jié)果相互驗證,證明了逆解計算的正確性。
圖9 運動學(xué)仿真曲線Fig.9 The kinematics simulation curve
當機構(gòu)的某一個驅(qū)動失效時,該處的轉(zhuǎn)動副變?yōu)槭Эㄋ?,但是機構(gòu)仍然具有部分活動能力。通過運動學(xué)分析可以得出失效時的工作空間。例如,當一個驅(qū)動組件在β3=135°的位置卡死時,工作空間仿真視圖如圖10、圖11所示。
圖10 β3=135°卡死時的工作空間(三維)Fig.10 The 3D workspace when jammed at β3 = 135°
對比圖10與圖5的工作空間視圖,當某一驅(qū)動組件出現(xiàn)卡死失效時,并聯(lián)機構(gòu)仍具備約1/3的工作空間。
圖11 β3=135°卡死時的工作空間(俯視)Fig.11 The top view of workspace when jammed at β3=135°
圖12 β3=135°卡死時點C最終位置Fig.12 The final position of C when jammed at β3=135°
為了驗證其冗余特性,將第5.1節(jié)中的第1組解代入ADAMS進行仿真,結(jié)果如圖12所示。動平臺 C點的目標位置為 xc=10 mm,yc=20 mm,zc=164 mm,由仿真結(jié)果可知,當某一驅(qū)動組件卡死時,并聯(lián)機構(gòu)的最終位置為 xc=11.57 mm,yc=22.75 mm,zc=167 mm,與目標位置相差不大,說明該并聯(lián)指向機構(gòu)具備較好的冗余特性。
本文設(shè)計了一種飛船用新型并聯(lián)式太陽電池陣指向機構(gòu),通過對其進行運動學(xué)正逆解計算及仿真分析,得出如下結(jié)論:
1)當目標姿態(tài)位置確定后,其輸入角有8組逆解,只有一組解作為唯一合理解,即將每個輸入角兩個解中的最大值進行組合;
2)進行了運動學(xué)正解、逆解的相互驗證,證明了正解、逆解的正確性;
3)當該并聯(lián)機構(gòu)中的某一驅(qū)動組件卡死時,機構(gòu)仍具備較大的工作空間,最終位置接近目標位置,可靠性較高;
4)該并聯(lián)式指向機構(gòu)還可用于航天器矢量推進器、天線指向等空間領(lǐng)域。
參考文獻(References)
[1] 郗曉寧,吳瑞林,潘亮,等.載人航天器的發(fā)射窗口及太陽能帆板的最佳受曬[J].中國空間科學(xué)技術(shù),1997,17(5): 54-60.Xi X N,Wu R L,Pan L,et al.The launching window of a manned spacecraft and the best exposure to solar panels[J].Chinese Space Science and Technology, 1997, 17(5):54-60. (in Chinese)
[2] 譚維熾,胡金剛.航天器系統(tǒng)工程[M].北京:中國科學(xué)技術(shù)出版社,2009:212-213.Tan W C, Hu J G.Spacecraft Systems Engineering[M].Beijing: Science and Technology of China Press, 2009:212-213.(in Chinese)
[3] Clavel R.Device for the movement and positioning of an element in space: United States Patent, 4976582[P].1989-09-06.
[4] Tsai L W,Walsh G C,Stamper R E.Kinematics of a novel three dof translational platform[C] //Proc.of 1996 IEEE Int.Conf.on Robotics and Automation, Minneapolis, Minnesota,1996:3446-3451.
[ 5 ] George Anwar, Liwei Lin.Robotic canfield joint[EB/OL].http://canfieldjoint.com, 2010.
[6] Lauren B,Nicolas R,Yann M.3POD:A high performance parallel pointing mechanism [C]//15th European Space Mechanisms& Tribology Symposium,Noordwijk,the Netherlands D.C.:ESMATS, 2013.
[7] 黃真,趙永生,趙鐵石.高等空間機構(gòu)學(xué)[M].北京:高等教育出版社,2006:141-166.Huang Z, Zhao Y S, Zhao T S.Advanced Spatial Mechanism[M].Beijing: Higher Education Press,2006:141-166. (in Chinese)
[8] 梅萊.并聯(lián)機器人[M].黃遠燦,譯.北京:機械工業(yè)出版社,2014:10-11.Mei L.Type Synthesis of Parallel Mechanisms[M].Huang Y C, translated.Beijing: China Machaine Press, 2014: 10-11.(in Chinese)
[9] 劉辛軍,汪勁松,李劍鋒,等.一種新型空間3自由度并聯(lián)機構(gòu)的正反解及工作空間分析[J].機械工程學(xué)報,2001, 37(10): 36-39.Liu X J, Wang J S,Li J F,et al.Direct and inverse kinematics and workspace analysis of a new typeof space 3DOF parallel mechanism[J].Journal of Mechanical Engineering,2001,37(10): 36-39. (in Chinese)
[10] Kumar V.Characterization of workspaces of parallel manipulators[J].ASME J.Mech.Des.1992a, 114: 368-358.
[11] Kumar V.Instantaneous kinematics of parallel chain robotic mechanisms[J].J.Mech.Des.1992b, 114: 349-358.
[12] 胡福生,郝秀清,陳建濤.3PSS并聯(lián)機構(gòu)的運動學(xué)分析[J].山東理工大學(xué)學(xué)報(自然科學(xué)版),2006, 20(1):43-46.Hu F S,Hao X Q,Chen J T.Kinematics analysis of 3PSS parallel mechanism [J].Journal of Shandong University of Technology(Sci&Tech),2006, 20(1):43-46. (in Chinese)