基于算子表達的柔性機器人動力學建模研究

鄭鐵軍

（中鋼設備有限公司，北京100080）

基于算子表達的柔性機器人動力學建模研究

鄭鐵軍

（中鋼設備有限公司，北京100080）

柔性機器人反向動力學是已知機器人末端廣義線速度、廣義角速度、廣義加速度以及每個鉸鏈和操作臂的廣義質量后，求解各鉸鏈的廣義力。以柔性機器人為研究對象，應用空間算子建立了一套新的關于鏈式開環柔性多體系統反向動力學的空間遞推算法。這個算法同樣適用于剛體機器人系統的反向動力學分析。經過對兩連桿柔性機器人計算和仿真驗證表明，與傳統的分析鏈式柔性多體系統反向動力學的O（N3）階算法相比，本算法是高效O（N）階的，并具有可編程性高，應用廣泛等特點。

柔性機器人；反向動力學；遞推；算子表達

隨著科技的進步，對柔性機器人的研究越來越廣泛[1-2]。柔性機器人的建模方法主要有以牛頓-歐拉方法為代表的矢量力學方法，以拉格朗日力學為代表的分析力學方法以及兼顧矢量力學和分析力學優點的凱恩方法[3]。研究O（n）次算法已經成為柔性機器人動力學研究領域中的重要內容[4]。本文以為柔性多體系統建立高效率模型為目的，以典型的柔性機器人為例，利用空間算子描述了鏈式柔性機器人的動力學，并且建立了一套高效率鏈式柔性多體系統的O（n）次遞推算法。與傳統的算法比較，該算法具有計算效率高，應用廣泛等特點。

1 柔性機器人系統建模及算子表達

1.1 坐標系建立

本文研究的對象是具有由n個鉸鏈將n個柔性機械臂連接成的柔性機器人系統，如圖1所示。鉸鏈和操作臂的序號是從系統的頂端向基座增加。k號鉸鏈是號機械臂與k+1號機械臂的連接鉸鏈。k號柔性體有限元模型包括一個質量矩陣Mk和一個剛度矩陣Kk，它們由對假定獨立的結構動力學分析得到。假定本系統中的鉸鏈是只有一個自由度，即可繞關節軸線進行旋轉。

圖1 柔性機器人模型示意圖

1.2 柔性機器人的運動學遞推

柔性機器人系統速度矢量V+（k）可以按照下式進行遞推：

其中：V+（N+1）=0表示鉸鏈靠近基體方向的N+1速度；定義vk+1（1）是相對速度矢量vk+1的第一個6自由度的元素；定義6×6 N矩陣CT（k+1，k）＝[φT（1，k），…，0].對這個方程的向外積分可得：

上式表示k鉸鏈靠近基體一側的速度。

k操作臂的模態空間速度Vm（k）∈RNˉ（k）為：

其中，Vm（k）為k體的模態速度；V（k）為k體的廣義速度；η（k）表示k體的節點坐標向量；χ（k）表示k體（以及鉸鏈k）的廣義速度向量。

2 反向動力學算法

本部分研究了基于算子表達的反向動力學遞推算法，即給定一系列系統狀態線速度、角速度以及廣義加速度，計算系統廣義力，相關算子參考文獻[4]。基于算子表達的反向動力學遞推算法表達為：

利用算子Φ（k，k-1）和K（k），上述遞推公式可進一步簡化。利用塊劃分和標入上標f和r表示柔性元素和剛性元素。

則上述遞推算法可以簡化為如下形式：

上述即為基于算子表達的柔性機器人反向動力學遞推快速算法，可以有效地進行了動力學的遞推，計算效率大大提高。

3 算例

為了驗證上述算法的效率和精度，作者在Mathematica中編寫了相應的算子表達程序。并且通過在ADAMS中以五連桿柔性機器人為例進行了仿真，與本算子表達計算柔性機器人反向動力學進行比較，比較柔性多體系統仿真程序的計算精度和計算效率。其中柔性機器人中各參數定義如表1所列。

表1 柔性機器人中各參數

SOA仿真分析與ADAMS的相應結果計算精度的比較，如圖2所示的為柔性機器人第一個關節速度曲線。從上述比較可以看出，本算法的計算精度與ADAMS比較接近。另外各個關節的速度和加速度兩者基本相同，本文沒有給出。仿真結果表明本遞推算法與ADAMS計算精度相近，但由圖3計算效率比較可知本算法的計算效率大大地提高，大約提高7~8倍。

圖2 SO A仿真結果與ADAMS相應結果的比較圖

圖3 算子表達與ADAMS消耗時間比較

4 結束語

本文基于空間算子建立了柔性機器人反向遞推動力學模型，并且可以推廣到鏈式柔性多體系統動力學建模應用中，并且柔性多體系統的自由度數越高，該算法的計算效率就會越明顯。

[1]B.Zi，J.Lin，S.Qian，Localization，obstacle avoidance planning and control of a cooperative cable parallel robot for multiple mobile cranes，Robot[J].Comput.-Integr.Manuf. 2015，34（0）：105-123.

[2]K.Kaltsoukalas，S.Makris，G.Chryssolouris，on generating themotion of industrial robotmanipulators，Robot[J].Comput-Integr.Manuf，2015，（32）：65-71.

[3]T.Martinec，J.Mlynek，M.Petru，Calculation of the robot trajectory for the optimum directional orientation of fibre place ment in themanufacture of composite profile frames，Robot[J]. Comput.-Integr.Manuf，2015，35（1）：42-54.

[4]Jain A，Rodriguez G．A spatial operator algebra for compu tationmultibody dynamics[M]．Italy：International Conference on Scientific Com putation and Differential Equations，Grado．1997.

The Recursive Inverse Dynamic of Flexible Robots Use Operator Description

ZHENG Tie-jun
（Sinosteel Equipment & Engineering Co.，Ltd.，Beijing 100080，China）

The inverse dynamics of the flexible robot is known as the generalized linear velocity，the generalized angular velocity，the generalized acceleration，and the generalized mass of each hinge and manipulator.In order to study the flexible robot，a new spatial recursive algorithm for the inverse dynamics of chain open loop flexible multibody system is established.This algorithm is also applicable to the inverse dynamic analysis of rigid body robot system.Through the calculation of two link flexible robot and the simulation shows that，with the inverse dynamics of flexible multibody systems analysis of chain of traditional O（N3）order algorithm,this algorithm is efficient O（N）order，and has the characteristics of high programmability，wide application etc..

operators；flexible robots；inverse dynamic；recursive

TP242

A

1672-545X（2016）09-0043-03

2016-06-17

鄭鐵軍（1980-），男，山東泰安人，碩士研究生，工程師，研究方向：機械自動化。