顯示多體動力學方程自動編制技術

李瑾岳，胡權，張景瑞

北京理工大學 宇航學院，北京 100081

顯示多體動力學方程自動編制技術

李瑾岳，胡權*，張景瑞

北京理工大學 宇航學院，北京 100081

為高效得到復雜柔性多體航天器的動力學方程解析表達式，研究了系統動力學方程自動編制技術。首先，基于Kane方法推導了構型簡單的鏈狀多體系統動力學顯式方程；然后，根據方程中各項物理意義和分布規律，開發了適用于樹狀構型多體航天器的解析動力學方程輸出程序，并運用Latex軟件對輸出文本進行二次編譯，增強輸出復雜數學公式的可讀性。所得方法極大地簡化了對此類航天器的建模工作。

多柔體系統；機械臂；顯式動力學方程；自動編寫；Kane方程

隨著航天任務的復雜化，航天器多為由多個部件組成的多體系統。建立此類系統的動力學方程成為系統特性分析和控制設計的前提。Hooker和Margulies首先將多體動力學的概念運用于航天器系統建模1]，基于牛頓/歐拉法推導了任意數量剛體組成的樹形多體系統動力學方程，但涉及的約束力消元成為該方法的難點。之后，Hooker使用拉格朗日方法避免方程中出現未知約束力2]，但拉格朗日法分析系統計算量大，得到的方程形式復雜，不易于分析。同一時期，達郎貝爾原理、漢密爾頓方法、波茲曼/海默方法等其他方法也都曾被用于系統分析3]。1960年起，Kane發表了系列論文4-6]，提出基于新的運動學變量——偏速度，簡化了方程的推導，僅需要將偏速度與已知向量(慣性力、慣性力矩、接觸力、接觸力矩)點乘，即可得到系統的運動方程。

以上方法可用于數值推導或符號推導系統動力學方程。對系統運動的解算，依賴方程的數值計算與求解；但是，若能獲得系統顯式的動力學方程，則能夠對系統特性分析提供模型參考。早期對于計算機符號分析法應用的嘗試未能取得成功，這是由于在對方程進行計算時，出現了大量的中間表達數，致使計算機內存不足7]。隨著Kane方法的運用，這一問題得到了解決。Levinson首先展示了Kane算法與符號分析法結合的可行性8]；幾乎同時，Schiehlen和Kreuzer宣布了基于符號分析法及牛頓/歐拉方程研發的多體動力學代碼，NEWEUL9]。不久之后Rosenthal及Sherman基于凱爾方法開發了商業軟件SD/EXACT10]。近些年，另一些符號動力學程序也被開發了出來，如AUTOLEV11]和SYMKIM12]。這些基于符號分析法的代碼非常適合運用于具有少量剛體的系統，但并不能很好地處理具有多個柔性體的模型。而大多數可處理具有大量柔性體系統的商業軟件仍然使用數值分析法13]。

本研究基于已有的顯式多體系統動力學方程，發現鏈狀及樹狀多柔體系統的顯式動力學方程形式上的規律，以及動力學方程形式與系統構型間的聯系，提出一種顯式系統動力學方程高效編寫方法。此方法適用于具有樹狀結構的多柔體系統，并可將柔體退化為剛體。同時為了提高輸出方程的可讀性，基于Latex排版程序對輸出文本進行了二次編輯，便于后續解析的分析各項的物理含義。最后給出了應用實例。

1 多柔體系統動力學方程的推導

以帶有一部機械臂系統的空間鏈狀多體系統為例，說明系統方程內部的固有規律。如圖1所示，中心體與機械臂間、機械臂的3節臂桿之間采用鉸鏈鉸接。假定每個鉸鏈具有1～3個相對轉動自由度。

圖1 目標系統的構型示意Fig.1 Structure of target system

1.1 系統的矢量定義

為方便描述系統及各臂桿運動，引入中心體體坐標系，其原點位于復雜連接體中心Ob,Xb軸、Yb軸與Zb軸為復雜連接體中心體的慣性主軸，且構成右手坐標系；機械臂臂桿坐標系，原點位于機械臂系統中第j節機械臂臂桿與其內接體的鉸鏈Oj處，坐標系各軸與第j節臂桿固連；在本系統中，j=1,2,3。

根據以上定義的位置矢量，可以得到各體質量微元在慣性系中的位置矢量14]：

(1)

(2)

式中：Aj,k表示從單位基向量bk到bj的坐標轉換矩陣。

位置矢量對時間求一階導數，便可求得系統中各體參考質量點的速度矢量。

(3) 2)第1節臂桿質量微元：

(4)

3)第2節臂桿質量微元：

(5)

4)第3節臂桿質量微元：

(6)

為簡化后續推導，定義：

(7)

(8)

(9)

速度矢量中，uj,j+1為因彈性變形而產生的位移。

速度矢量對時間再次求導即可得加速度矢量，這里不再給出加速度矢量的具體形式。

1.2 動力學方程的推導

Kane方程15-16]的一般形式：

(10)

在上述廣義力公式中，Gh為偏速度向量，系統廣義速度表示為v，則有：

(11)

式中：Wh為選定的系統廣義偏速度15]。

由式(11)可得，偏速度向量Gh可表示為速度向量v對各階偏速度Wh求導所得向量，即：

(12)

將各體質量微元的偏速度、加速度代入Kane方程，可得各體的動力學方程。

1)中心體的平動方程：

(13)

2)中心體的轉動方程：

(14)

3)第k節機械臂的轉動方程：

(14)

由以上各項的物理含義，可以發現顯式系統動力學方程的形式與系統的構型有關，且在形式上規整，具有很強的規律性。

2 樹狀構型多體系統動力學方程

當系統為樹狀構型時，動力學方程形式會發生變化，原有顯式方程形式上的規律也將隨系統構型發生變化。

以圖 2所示系統為例，說明方程各項的修正方法。為減小方程推導計算量，將系統退化為剛性。同上節推導思路，直接給出系統各體的顯式動力學方程，并找出規律。

圖2 存在樹狀構型的示例系統Fig.2 Target system with tree structure

1)中心體的平動方程：

(15)

(16)

3)第1系統中第1節機械臂的轉動方程：

(17)

4)第1系統中第2節機械臂的轉動方程：

(18)

5)第2系統中第1節機械臂的轉動方程：

(19)

通過觀察推導方程形式，得出結論：

樹狀構型系統顯式動力學方程形式與鏈狀構型系統顯式動力學方程形式類似，方程中描述中心體運動的相關項不變，僅描述機械臂的運動的部分項發生變化，由原來描述單一機械臂運動的單一項變為描述多個機械臂運動的多個項的疊加。

3 程序框架介紹

由上節推導多體航天器系統動力學方程，發現顯式動力學方程在形式上與系統構型關聯，形式規整具有規律性。通過運用顯式方程形式上的規律，編寫了顯式動力學方程自動編制程序。圖3給出了程序流程。

圖3 程序工作流程Fig.3 Flowchart of the program

程序分為兩大部分，一部分存儲動力學方程的所有子項。另一部分負責處理輸入構型。使用程序時，根據提示輸入系統構型，包括機械臂數量及臂桿數量，并聲明中心體及每個臂桿的剛、柔性等其他系統信息。完成信息輸入后，程序會根據輸入信息，調用相應的子項，并根據輸入信息對子項編號(即程序自動標注子項中的上下角標信息)。完成子項處理后，根據輸入系統構型信息，結合上節得出的方程構成規律，自動組合子項，得出目標系統的動力學方程。

程序采用C語言編制，因此具有眾多上下角標及特殊符號的數學方程難以辨識。為解決此問題，使程序輸出包含符合Latex程序語言規則的“.tex”文本文檔，輸出符合數學公式閱讀習慣的文本。這里使用了Windows操作系統上的基于Latex的Ctex編譯器進行二次編譯。最終文檔以PDF文檔形式輸出。Latex編輯輸出的文檔相比DOS直接的輸出文檔更易于閱讀。

使用Kane方程推導該系統動力學方程，所得到的方程與程序輸出方程一致，證明了該程序的正確性。

4 軟件應用實例

航天器帶有一部6自由度機械臂及一部可轉動天線，航天器中中心體視為柔性體，機械臂中第1、2、3節臂桿視為柔性體，4、5、6節臂桿視為剛體。通過自動編制程序寫出其顯式動力學方程。將柔性天線視為一部具有1節臂桿的機械臂系統。輸入系統構型之后，程序開始自動編寫，編譯完成后生成equation.pdf文檔。給出部分文檔內容,如圖4所示。

5 結束語

本文研究了樹狀構型多體系統動力學顯式方程的自動編制方法。首先基于Kane方程推導了鏈狀構型多柔體系統的動力學方程，通過觀察、分析方程中各項的物理意義和規律，編寫了顯式多體動力學方程自動編制程序。程序避免了人工推導復雜多體航天器系統顯式方程，為后續動力學建模和分析提供了解析的模型基礎。

References)

[1] HOOKER W W,MARGULIES G. The dynamical attitude equation for an n-body satelliteJ]. Journal of the Astronautical Sciences, 1965, 12(4):123-128.2] HOOKER W W. A set of r dynamical attitude equations for an arbitrary n-body satellite having r rotational degrees of freedomJ].AIAA Journal, 1970, 8(7):1205-1207.

[3] KANE T R, LEVINSON D A. Formulation of equations of motion for complex spacecraftJ]. Journal of Guidance and Control, 1980, 3(2):99-112

[4] KANE T R. Partial rates of change of position and of orientationJ]. Bulletin of Mechanical Engineering Education, 1960, 2(17):17-24.

圖4 經Latex編譯后的部分文檔示例Fig.4 An example of text compiled by Latex

[5] KANE T R.Dynamics of nonholonomic systemsJ]. Journal of Applied Mechanics, 1961, 28(4):574-578.

[6] KANE T R, WANG C F. On the derication of equations of motionJ]. Journal of the Society for Industrial and Applied Mathematics, 1965, 13(2):487-492.

[7] ARUN K B. Contributions of multibody dynamics to space flight: a brief reviewJ]. Journal of Guidance, Control, and Dynamics, 2003, 26(3):385-394.

[8] LEVINSON D A. Equations of motion for multiple-rigid-body systems via symbolic manipulationJ]. Journal of Spacecraft and Rockets, 1977, 14(8), 479-487.

[9] SCHIEHLEN W, KREUZER E. Symbolic computerized derivation of equations of motionM]∥MAGNUSK. Dynamics of Multibody Systems.Berlin: Springer-Verlag,1978:290-305.

[10] ROSENTHAL D E, SHERMAN M A. High performance multibody simulations via symbolic equation mainpulation and Kane′s methodJ]. Journal of the Astronautical Sciences, 1986, 34(3):223-239.

[11] LEVINSON D A, KANE T R. AUTOLEV—a new approach to multibody dynamicsM]∥SCHIEHLENW. Multibody Systems Handbook. Berlin: Springer-Veralg, 1990:81-102.

[12] KECSKEMETHY A, KRUPP T, HILLER M. Symbolic processing of multiloop mechanism dynamics using closed-form kinematics solutionsJ]. Multibody System Dynamics, 1997, 1(1):23-45.

[13] BODLEY C S, DEVER A D, PARK A C,et al.A digital computer program for thedynamic interaction simulation of controls and structureJ].Oranization Studies,1978(8):149-168.

[14] 黃文虎，邵成勛. 多柔體動力學M]. 北京：科學出版社，1996:15-18.

[15] PETER C H. Spacecraft attitude dynamicsM]. New York: Dover Publications, 2004.

[16] 胡權，賈英杰，徐世杰. 多體系統動力學Kane方法的改進J]. 力學學報，2011(5):968-972.

HU Q, JIA Y J,XU S J. An improved Kanes method for multibody dynamicsJ]. Chinese Journal of Theoretical and Applied Mechanics, 2011(5):968-972(in Chinese).

(編輯：高珍)

Automatically generating explicit equations of motion for multi-body systems

LI Jinyue,HU Quan*, ZHANG Jingrui

SchoolofAerospaceEngineering,BeijingInstituteofTechnology,Beijing100081,China

The development of the complex multibody spacecraft raises higher requirement to multi-body dynamics modeling and control technology. The explicit dynamics equations of the system are always needed to analyze system′s characteristics and design controllers, but the complexity of system brings difficulty to deriving the equations. In order to solve this problem,the explicit form of dynamics equations′ analytical expression was inferred by using Kane′s method, the chain structure system′s explicit dynamics equations;then, by analyzing this equation, physical meaning and regularities of distribution of each equation item were established;using those regularities, a program that can output the explicit dynamics equations of spacecraft system with tree structure was developed. This program reduces the workload of modeling this type of spacecraft significantly.

multi-body system; robotic arm; explicit formation of dynamics;auto writing; Kane equation

10.16708/j.cnki.1000-758X.2017.0005

2016-07-12；

2016-10-10；錄用日期：2016-11-24；

時間：2017-02-16 16:48:33

http:∥www.cnki.net/kcms/detail/11.1859.V.20170216.1648.004.html

國家自然科學基金(11502018，11572037)

李瑾岳(1993-)，男，碩士研究生，ljy19930530@126.com，研究方向為空間機器人姿態動力學與控制

*通訊作者：胡權(1987-)，男，助理教授，huquan2690@163.com，研究方向為航天器姿態動力學與控制

李瑾岳,胡權,張景瑞.顯示多體動力學方程自動編制技術J].中國空間科學技術, 2017,37(1)：49-56.LIJY,HUQ,ZHANGJR.Automaticallygeneratingexplicitequationsofmotionformulti-bodysystemsJ].ChineseSpaceScienceandTechnology, 2017,37(1)：49-56(inChinese).

V43

A

http:∥zgkj.cast.cn