摘要：利用拉格朗日法和假設模態方法建立了末端柔性的兩臂漂浮基空間機器人的非線性動力學方程．通過坐標變換，推導出一種新的以可測關節角為變量的全局動態模型，并在此基礎上運用基于模型的非線性解耦反饋控制方法得到關節相對轉角與柔性臂的彈性變形部分解耦形式控制方程．最后，討論了柔性臂漂浮基空間機器人的軌跡跟蹤問題，并通過仿真實例計算，表明該模型轉換及控制方法對于柔性臂漂浮基空間機器人末端軌跡跟蹤控制的有效性． 關鍵詞：柔性臂漂浮基空間機器人；動力學；模型轉換；軌跡跟蹤控制 Modeling and Trajectory Tracking Control of a Free-Floating Space Robot with Flexible M anipulators —HONG Zai．di ，YUN Chao ，CHEN Li （1．Beihang University，Beijing 100083，China； 2．Fuzhou University。Fuzhou 350002，China） Abstract：Nonlinear dynamic equations of a free——floating space robot with two manipulators and a flexible end—manipulator are established based on Lagrange and assumed mode methods．Its new global dynamic model in terms of measured joints is derived by coordinate transformation，and the decoupled control quations for joint relative angles and elastic parts of the flexible manipulator are obtained with the model—based nonlinear decoupling feedback control method．Trajectory tracking control of the free floating space robot with flexible manipulators is iscussed，and the numerical simulation shows that the proposed model transformation and control method is eficient in trajectory tracking control of free floating space robot with flexible manipulators． Keywords：free—floating space robot with flexible manipulators；dynamics；model transformation；trajectory tracking control 1 引言（Introduction） 漂浮基空間機器人是機器人的一個重要發展方向，其主要任務是在宇宙空間代替宇航員完成捕捉失效衛星、建造空間站、維修空間站設施等工作，其原理模型如圖1所示．為節省控制燃料、增加空間機器人的有效使用壽命，進而減少發射費用，空間機器人在操作過程中載體位置、姿態均不受控制，且一般使用質量輕、臂展大的柔性操作臂．在這種情況下，機械臂的運動與載體的位姿之間、柔性臂的剛體大位移和彈性振動之間存在著強烈的動力學耦合作用．在操作過程中，機械臂的相對運動引起載體位姿的變化，柔性臂的彈性振動影響關節、末端軌跡跟蹤精度．其突出特點表現為：空間機器人為非完整動力學系統，系統動力學方程關于系統慣性參數呈非線性函數關系，系統運動Jacobi關系不僅與系統幾何參數有關，還與質量等慣性參數以及柔性臂抗彎剛度有關．在上述情況下，在空間機器人動力學分析及控制規律的設計中應考慮結構彈性，這大大增加了控制系統的設計難度．目前，空間機器人的研究工作已開展了很多¨ J，值得注意的是，其中大部分研究工作是針對剛性臂的空間機器人進行的，而針對柔性臂空間機器人的研究相對較少．顧曉勤 副提出了消除彈性變形對負載位姿影響的方法，并進一步尋求最小驅動力矩及抑制彈性振動的控制規律。本文應用拉格朗Et建模方法和假設模態柔性變形描述方法建立末端柔性的兩臂漂浮基空間機器人的非線性動力學方程，通過坐標變換 J，推導出一種新的以可測關節角為變量的全局動態模型．在此基礎上，運用基于模型的非線性解耦反饋控制理論，對動力學方程進行部分線性化，實現關節相對轉角與柔性臂的彈性變形部分解耦，從而由剛性臂空間機器人逆運動學方法確定關節角的運動規律，進而利用柔性機械臂的力矩控制方法求出關節驅動力矩，以保證臂末端的實際軌跡達到跟蹤的期望軌跡．通過仿真實例計算，證明了該模型轉換及控制方法在柔性臂漂浮基空間機器人應用中的有效性． 2 系統的運動學與動力學（Kinematics and dynamics） 2．1 模型建立 不失一般性，考慮做平面運動的末端柔性的兩臂漂浮基空間機器人系統，如圖1．系統由漂浮的剛性載體B[sub]0[/sub] 剛性連桿B[sub]1[/sub] 和末端柔性連桿B[sub]2[/sub] 組成．建立各分體B[sub]i[/sub] 的聯體坐標系（0[sub]i[/sub] 一x[sub]i[/sub]y[sub]i [/sub]）（i=0，1，2），其中0[sub]0[/sub]與b[sub]0[/sub]的質心0[sub]c0[/sub]重合，0[sub]1[/sub] 、0[sub]2[/sub]：分別與連接b[sub]0[/sub]與B[sub]1[/sub]、B[sub]1[/sub]與B[sub]2[/sub]的轉動鉸中心重合； x[sub]0[/sub]與0[sub]0[/sub]0[sub]1[/sub]重合， x[sub]1[/sub]為機械臂的對稱軸，x[sub]2[/sub]是機械臂B[sub]2[/sub]未變形時的對稱軸，且在運動中始終與柔性梁在0[sub]2[/sub]相切．設0[sub]1[/sub]在0[sub]0[/sub]x[sub]0[/sub]軸上與0[sub]0[/sub]的距離為l[sub]0[/sub]，b[sub]1[/sub]質心0[sub]c1[/sub]沿0[sub]1[/sub]x[sub]1[/sub] 的長度為a，B[sub]i[/sub]沿0[sub]i[/sub]x[sub]i[/sub]的長度為l[sub][/sub]（i=1，2）；分體B[sub]i[/sub]質量和中心慣量分別為m[sub]i[/sub]和l[sub]i[/sub]（i=0，1），且柔性蓮桿線密度為P． 任取一點0建立系統參考慣性坐標系（0-XY），各分體沿（ x，y）平面做平面運動，設e[sub]i [/sub]為x[sub]i[/sub]（ =0，1，2）軸的基矢量，矢量e[sub]3[/sub] 為Y[sub]2[/sub]軸的基矢量．忽略柔性臂軸向變形，由Euler—Bemolli梁理論，柔性臂的彈性位移“模態函數展開表示為： 其中φ[sub]i[/sub]（x[sub]2[/sub]）為柔性臂第i階模態函數，δ[sub]i[/sub]（t）為與φ[sub]i[/sub]（x[sub]2[/sub]）對應的模態坐標． 設各分體質心0[sub]ci[/sub]相對0的矢徑為r[sub]i[/sub]（i=0，1），柔性臂上任一點P相對0的矢徑為r．由系統幾何關系得： 設載體、剛性連桿、柔性連桿的動能分別為Ti（i=0，1，2），系統的總動能為T，由理論力學知識易得到： 則本文中變量上標“·”和“[sup]..[/sup]”分別表示相應變量對時間的一階導數和二階導數。 忽略重力的作用，可認為整個系統重力勢能為零；且柔性機械臂為線彈性變形，故系統總勢能等于柔性連桿的彎曲應變能．由材料力學相關理論，并取系統廣義模態坐標前兩項得： 其中EI為柔性臂抗彎剛度。故系統的拉氏函數為L＝T[sub]0[/sub]＋T[sub]1[/sub]＋T[sub]2[/sub]－V. 假設空間機器人系統在操作過程中處在漂浮狀態，載體的姿態和位置均無控制，則設變量為系統廣義坐標，其中x[sub]0[/sub]、y[sub]0[/sub]為矢徑r[sub]0[/sub]分別向X 、Y軸投影的值，α為x[sub]0[/sub]軸相對X軸的偏角，θ[sub]1[/sub]為x[sub]1[/sub]軸相對x[sub]0[/sub]軸的轉角，θ[sub]2[/sub]為x[sub]2[/sub]軸相對x[sub]1[/sub] 軸的轉角，因此相應的廣義力為其中為o[sub]1[/sub]、o[sub]2[/sub]鉸關節控制力矩．由于空間機器人系統在操作過程中處在漂浮狀態，載體的姿態和位置均無控制，且忽略重力的影響，空間機器人系統為無外力作用的自由浮動無根多體系統，遵守對（0-XY）的動量守恒及相對0點的動量矩守恒關系，即系統運動受到線動量守恒及角動量守恒關系的約束．不失一般性，設系統相對（0-XY）的初始動量和相對0點的初始動量矩均為零，載體、剛性機械臂和柔性機械臂相對于坐標系（0-XY）的動量分別為Q （i=0，1，2），系統總動量Q-根據理論力學知識得： 則。將．將Q分別向X軸和Y軸投影，結合假設初始條件推導寫成矩陣形式如下： 將拉氏函數和廣義力代入拉格朗日方程： 其中q[sub]i[/sub]為系統的廣義坐標， F[sub]i[/sub]為廣義坐標q[sub]i[/sub] 相對應的廣義力．不考慮結構粘性阻尼，結合式（12），經過推導并整理，可得到如下封閉形式的柔性臂空間機器人系統的動力學非線性方程； 其中，為4×4正定、對稱、時變廣義質量陣，，包含哥氏力、離心力和彈性力，為變量耦合4×1列陣．記M[sub]4×4[/sub]= 2.2 模型轉化 式（14）給出模型夫于變量0的方程，但在實際系統中θ的方程，但在實際系統中，θ[sub]1[/sub]θ[sub]2[/sub]只能得到由編碼器測的角位移θ[sub]c[/sub]： 3 軌跡跟蹤控制（Trajectory tracking contro1） 式（16）是關于σ 、θ[sub]c[/sub]、δ變量的系統動力學方程，對于臂末端軌跡跟蹤控制系統，由于彈性變形變量是不可觀i貝4的，利用非線性解耦反饋控制方法對式（16）進行部分線性化．式（16）寫成兩式： 式（2O）在形式上與剛性臂漂浮基空間機器人的方程相似，類似于剛性臂漂浮基空間機器人的廣義質量陣；類似于剛性臂漂浮基空間機器人的非線性哥氏力、離心力項． 設基于模型的控制規律為： 其中為給定的期望關節角軌跡、角速度和角加速度規律．式（19）一（23）導出柔性臂空間機器人系統的控制方程如下： 式（24）對應于機械臂關節變量θ[sub]c[/sub]的線性方程組，式（25）對應于彈性變量δ的耦合非線性方程組．式（2O）、（22）一（25）構成了基于非線性解耦反饋控制的軌跡跟蹤控制方案． 設關節角偏差e（t）=θ[sub]c[/sub]（t）一θ[sub]d[/sub]（t），由式（24）可得偏差方程如下： 選擇適宜的K[sub]p[/sub]和K[sub]v[/sub] 可使式（26）完全解耦，進而使機械臂關節角θ[sub]c[/sub]跟蹤期望的關節角軌跡θ[sub]d[/sub]．柔性臂空間機器人末端軌跡跟蹤過程為：利用剛性臂空間機器人的逆運動學方程求出與臂末端軌跡對應的各關節角運動規律，再由帶柔性臂空間機器人的力矩控制方程確定關節的驅動力矩，輸入到系統中得到柔性臂空間機器人末端跟蹤期望軌跡的實際運動軌跡． 4 仿真算例（Simulation example） 設空間機器人系統動力學參數如下： 反饋增益矩陣 K[sub]p[/sub]=diag[22]，K[sub]v[/sub]=diag[160 160]． 本系統柔性機械臂可視為懸臂梁，由振動理論可知，懸臂梁的主振型函數為： 取前二階模態（i=1，2），由懸臂梁的振動模態可知： 仿真采用末端期望軌跡規律： 仿真結果如下： 5 結論（Conclusion） 由于漂浮基空間機器人采用輕質細長機械臂，結構彈性在軌跡跟蹤控制規律中的設計中必須予以考慮。在操作過程中，機械臂的運動引起載體位姿的變化，柔性臂的振動影響關節、末端軌跡跟蹤精度，這使得末端軌跡跟蹤十分困難。理論分析及仿真結果表明，本文所提出模型轉換及控制方法對于求解非線性、強耦合性的柔性臂漂浮基空間機器人末端的軌跡跟蹤控制是有效的，而且實際運動軌跡與設定期望相比誤差也較小，已經滿足控制設計要求。本文所述的模型轉化方法給柔性臂浮基空間機器人反饋控制器的設計和實現帶來方便，可減少在實際控制中由于動力學模型變量與實際檢測變量不同而引起的變量轉換，且可有效抑制柔性臂振動． 進一步仿真分析發現，為了滿足跟蹤誤差精度要求，可適當調整K[sub]p[/sub] 、K[sub]v[/sub]值；增加K[sub]p[/sub]值，可以有效抑制機械臂末端的振動并降低跟蹤誤差；在同等精度條件下， 。取值比在全剛性機械臂情形下尢從圖3可知，當空間機器人運動時，柔性臂將會出現一定的微振動，這是考慮機械臂的彈性變形所引起的．本文的模型轉換及控制方法雖然是針對末端柔性的兩臂空間機器人系統提出的，但同樣適用于一般多柔性臂的空間機器人系統． [1] Papadopoulos E G，Dubwsky S．On the nature of control algorithms for free floating space manipulators[J] IEEE Transactions on Robotics and Automation，199 ，7（6）：750—758． [2] 陳力，劉延柱．漂浮基空間機器人協調運動的自適應控制與魯棒控制[J] 機械工程學報，2001，37（8）：18—22． [3] 陳力，劉延柱．參數小確空間機械臂的增廣自適應控制[J]．航空學報，000，21（2）：150—154． [4] 陳力，劉延柱．空間機器人狀態與末端抓手協調運動的魯棒自適應控制[J]，工程力學，2002，19（2）：165—170， [5 ] 陳力，劉延柱．漂浮摹帶滑移鉸空間機械臂的分解運動自適應控制算法[J]．應用力學學報，2000，17（4）：131—137． [6] 洪在地，陳力．漂浮基空間機器人雙臂協調操作逆運動學的完全笛卡爾坐標方法[J]，機械科學與技術，2003，22（6）：931— 933． [7] 顧曉勤：彈性空間機械臂動力學與控制[J]，空間科學學報，1997，17（4）：377—381． [8] 顧曉勤，譚朝陽．漂浮彈性空間機械臂動力學及振動抑制[J]．宇航學報，1999，20（3）：9l一95， [9] 朱蓓蓓，徐建閩，周其節．兩連桿柔性前臂機器人的模型[J]．華南理工大學學報（自然科學版），1997，25（12）：8—11． 作者簡介： 洪在地（1977一），男，博士生．研究領域：機器人技術． 負超（1952一），男，教授．研究領域：柔性多體系統動力學，機器人技術和機器人控制． 陳 力（1961-），男，博士，教授．研究領域：多體系統動力 學，空間機器人系統動力學與控制，非線性振動及振動控制．