傳動柔性及負載變化彈藥傳輸機械臂位置控制及柔性振動抑制

傳動柔性及負載變化彈藥傳輸機械臂位置控制及柔性振動抑制

郭宇飛1,2，侯保林2

(1.武漢科技大學機械自動化學院，武漢430081；2.南京理工大學機械工程學院，南京210094)

摘要：針對現有坦克自動裝彈機無法實現任意角度裝填問題，設計出兩自由度的彈藥傳輸機械臂。研究考慮鏈條、轉鉸柔性且負載變化情況彈藥傳輸機械臂位置控制與柔性振動抑制。將鏈條與轉鉸簡化為線性無慣量彈簧，采用第二類Lagrange方法建立彈藥傳輸機械臂剛柔耦合動力學模型。基于奇異攝動技術設計系統混合控制策略，柔性振動抑制采用速度反饋控制；剛性部分大范圍運動采用基于隱式Lyapunov函數的連續時變增益PD控制，控制器增益為系統狀態變量的可微函數，隨系統狀態變量逐漸趨向于零，增益逐漸趨于無窮大，而控制力始終保持在有界范圍內。仿真結果顯示，該混合控制器能克服負載變化及柔性振動影響，實現彈藥傳輸機械臂點到點位置控制及柔性振動抑制，具有較強的魯棒性。

關鍵詞：彈藥傳輸機械臂；傳動柔性；負載變化；位置控制；振動抑制

中圖分類號:Tp12；Tp13.3文獻標志碼：A

基金項目：國家自然科學

收稿日期：2014-07-09修改稿收到日期：2014-11-06

Positioning control and elastic vibration suppressing of an ammunition transfer manipulator with transmission flexibility and payload uncertainty

GUOYu-fei1,2,HOUBao-lin2(1. College of Mechanical Automation, Wuhan University of Science and Technology, Wuhan 430081, China;2. School of Mechanical Engineering, Nanjing University of Science and Technology, Nanjing 210094, China)

Abstract:The positioning control and elastic vibration suppressing of a novel 2-DOF ammunition transfer manipulators were analysed in consideration of joint chain flexibility and payload uncertainty. Regarding the joint and chain’s elasticity as a non-inertial spring, a dynamic model of the manipulator was derived via Lagrange method. Based on the singular perturbation method, the model was decomposed into two part, a fast subsystem and a slow subsystem. For the fast subsystem, a velocity difference feedback controller was proposed to suppress the elastic vibration. For the slow subsystem, a PD controller with continuous time-varying gains was designed based on a given implicit Lyapunov function. The controller’s gains, which are continuous-differentiable functions of the state, increase and tend to infinity as the system approaches the original state, but the control force always satisfies the given constraint. The simulation results demonstrate that the controller greatly compensates the effects of transmission flexibility and payload uncertainty, fulfills the accurate point to point control of the ammunition transfer manipulator, and is of good robustness.

Key words:ammunition transfer manipulator; transmission flexibility; payload uncertainty; positioning control; vibration suppressing

彈藥傳輸機械臂作為坦克自動裝彈機重要組成部分，安裝于坦克車體內彈藥倉與炮尾之間，負責將彈藥協調到炮尾待裝填位置，稱為彈藥協調器[1]。傳統彈藥協調器為單自由度機械臂結構，無法實現彈藥任意角度裝填[2]。本文設計的兩自由度彈藥傳輸機械臂，兼有任意角度協調及抓取、推送彈藥功能。

作為坦克自動裝彈機的重要組成部分，彈藥傳輸機械臂朝輕量化方向發展。因此，結構設計、控制動力學分析階段須考慮系統柔性影響。本文主要研究彈藥傳輸機械臂傳動關節的柔性。來自驅動部件、傳動部件與傳感器(如電機輸出軸、諧波減速器、傳動鏈/帶、力矩傳感器等)的結構柔性會產生系統諧振，嚴重影響機械臂的運動精度及控制穩定性。

Spong[3]對柔性關節機器人通過大量研究，率先建立柔性關節機械臂動力學模型，將柔性轉動關節簡化為線性扭簧。該模型基于關節弱柔性假設，適用于關節柔性力遠大于電機驅動力的一類機器人?？刹捎昧刎摲答丳D控制策略對柔性關節振動進行主動抑制。該控制策略需較高質量關節力矩信號及魯棒性較好的力矩控制器[4-5]。郭闖強等[6]設計的輪輻式力矩傳感器，結合名義輸出力矩前饋補償器，可實現系統柔性振動快速抑制。也可引入不同時間尺度，將系統分解為慢、快時變子系統，用混合控制方法進行系統位置控制與柔性振動抑制，即奇異攝動方法?？蛇x擇關節彈性力作為快時變變量，也可選擇電機輸出軸與機械臂本體角度差作為快時變變量。慢時變子系統控制器可選任何適用剛體機器人的控制策略，如自適應控制[7]、神經網絡控制[8]、非奇異模糊Terminal滑模控制[9]等?？鞎r變子系統控制器一般選速度反饋控制、最優控制[10]等控制策略。

針對文獻[3]模型中未考慮參數不確定、摩擦、阻尼、簡化扭簧剛度時變等非線性因素，趙志剛等[11]作進一步研究，建立更完整的柔性關節機械臂動力學模型。陳健康等[12]針對柔性關節非線性摩擦特性，提出基于H∞魯棒原理的控制策略，在頻域范圍內分析摩擦的描述函數。黨進等[13-14]針對柔性關節中存在的摩擦力及不確定擾動，提出由前饋補償器結合反饋補償器、模糊滑模控制器的魯棒控制策略。Chaoui等[15]采用自適應二型模糊控制策略，研究考慮參數不確定、非線性摩擦力的關節柔性機械臂軌跡跟蹤控制。計算結果顯示二型模糊控制律較一型魯棒性更強。

本文針對兩自由度彈藥傳輸機械臂，考慮鏈傳動、轉動關節柔性及負載變化影響，建立剛柔耦合動力學模型；利用奇異攝動技術引入雙時間尺度，將系統分解為快、慢時變子系統；對兩子系統分別采用速度差值反饋控制及隱式Lyapunov函數時變增益PD反饋控制律[16-17]，研究彈藥傳輸機械臂點到點的位置控制及柔性振動抑制。

1彈藥傳輸機械臂模型

1.1結構原理與動力學建模

彈藥傳輸機械臂三維模型見圖1，結構原理見圖2。該結構由安裝架、升降部分與翻轉部分組成。安裝架固定在車體內，位于炮尾與彈藥倉之間；升降部分采用雙鏈傳動，兩主動鏈輪同軸固定且由同一電機驅動；升降部分固定在緊邊鏈條上，可沿導軌上下滑動；翻轉部分由電機通過減速器、轉向器驅動，可360°翻轉，兼有抓取與推送彈藥功能。

圖1　彈藥傳輸機械臂三維模型 Fig.1 3D model of the ammunition transfer manipulator

圖2　彈藥傳輸機械臂的結構原理 Fig.2 Structural model of the ammunition transfer manipulator

簡化彈藥傳輸機械臂，即①將彈藥傳輸機械臂本體簡化為升降加翻轉部分。②將鏈條簡化為集中質量加無慣量線性彈簧，見圖3。其中XOY為笛卡爾坐標系；C1，C2，C3分別為鏈條、升降與翻轉部分質心；L為C2與C3之距離；O2為翻轉部分轉軸中心，與升降部分質心重合；yl，y1，θ2分別為鏈條、升降部分與翻轉部分位移(角位移)；k1為彈簧剛度系數。③將翻轉部分與驅動電機間減速器的轉動慣量等效到電機輸出軸上，電機輸出軸與翻轉部分由無慣量線性扭簧連接，見圖4。其中k2為扭簧剛度系數；θd為電機輸出軸轉角。

圖3　彈藥傳輸機械臂與鏈條簡化模型 Fig.3 Simplified model of the ammunition transfer manipulator with flexible chain

圖4　柔性關節簡化模型 Fig.4 Simplified model of the flexible-joint

基于以上簡化模型，用Lagrange法建立系統動力學方程為

(1)

式中：ml，m1，m2為鏈條、升降與翻轉部分質量；J2，I為翻轉部分及等效到電機轉軸上的轉動慣量；g為重力加速度。

1.2奇異攝動模型

鏈條、翻轉部分轉鉸柔性會引起系統彈性振動。剛柔位移誤差不斷累積會嚴重影響系統控制精度。因此，系統控制器設計不僅考慮彈藥傳輸機械臂本體姿態位置控制，且須考慮系統柔性振動的主動抑制。本文采用奇異攝動法，將系統分解為快、慢兩時間尺度子系統，針對各子系統分別設計控制器，再將兩控制器相加獲得系統混合控制器。

據式(1)建立系統的奇異攝動模型。引入柔性力變量為

z=K(q2-q)

(2)

定義z為系統的快時變變量，q為慢時變變量。引入新剛度矩陣為

K1=ε2K

(3)

式中：ε為正極小量。

將式(2)、(3)代入式(1)，得系統奇異攝動模型為

(4)

分別求解奇異攝動模型的慢、快時變子系統。

1.2.1慢時變子系統

設ε=0，由式(4)第二式得

(5)

將式(5)代入式(4)第一式，得慢時變子系統動力學方程為

(6)

式中：τs為慢時變子系統廣義控制力。

H(q)=D1(q)+D2

(7)

可見，慢時變子系統動力學方程與不考慮柔性時系統剛性動力學方程完全相同。

式動力學方程具有性質[18]為

性質1慣量矩陣H(q)為正定對稱矩陣，且上下有界，即對任意向量λ，有

mλ2≤‖λTH(q)λ‖≤Mλ2

性質2慣量矩陣H(q)的偏微分大小有界，即

性質3存在常數τ0>0，使廣義控制力向量滿足‖τs‖≤τ0。

1.2.2快時變子系統

由式(4)第一式得

(8)

將式(8)代入式(4)第二式，得

(9)

(10)

將ε=0代入式(10)，得

(12)

將式(11)代入式(12)，得

(13)

式中：τf=τ-τs為快時變子系統廣義控制量。

引入快變時間尺度σ=t/ε，式(13)可改寫為

(14)

(15)

2控制器設計

2.1混合控制策略

由計算過程可知，系統控制輸入由慢時變子系統控制量τs與快時變子系統控制量τf組成，即

(16)

其中，慢時變子系統控制器作用為實現彈藥傳輸機械臂位置控制；快時變子系統控制器作用為實現系統柔性振動主動抑制。見圖5。

圖5　彈藥傳輸機械臂混合控制原理 Fig.5 Composite control of the ammunition transfer manipulator

分別設計快、慢時變子系統的控制器。選擇快時變子系統控制器為

(17)

式中：Kf=K2/ε，K2為正定對角陣?？赏ㄟ^速度差值反饋不斷調節保證系統穩定性。

2.2慢時變子系統控制器設計

2.2.1控制器設計

考慮系統慣量不確定即負載變化，視其與式(6)中重力項為系統所受不確定擾動，則彈藥傳輸機械臂的剛性不確定動力學方程可寫為

(18)

式中：S為不確定擾動，含重力項與慣量不確定項Δ。

S=-G(q)+Δ

(19)

設S大小有界，即存在S0>0，使‖S‖≤S0。選慢時變子系統控制器為

(20)

式中：

(21)

(22)

2.2.2穩定性分析

引入變量為

(23)

將式(21)、(23)代入式(22)，化解得

16x4-ξ2x2-ηx-γ2=0

(24)

式中：x為變量；ξ，η，γ為方程系數，滿足兩條件：

條件1由H(q)的正定性，易得關系式

ξ2+γ2≥0

(25)

條件2據Cauchy不等式，得

(26)

即

(27)

定理1對滿足條件、(27)的方程

f(x)=16x4-ξ2x2-ηx-γ2=0

據柯西不等式、式(21)可得不等式為

(28)

由式(22)、(28)得

(29)

(30)

式中：

(31)

因H(q)可逆，則據式(18)有

(32)

將式(31)、(32)代入式(30)，化解得

(33)

(34)

因

(35)

式(34)可化解為

(36)

分別化解式(36)右邊三項。據式(21)、(22)得

(37)

由柯西不等式與性質2得

(38)

據式(29)與式性質1得

(39)

將不等式(39)代入式(38)，得

(40)

由柯西不等式、性質1與‖S‖≤S0得

(41)

定義

(42)

將式(37)、 (40)～ 式(42代入式(36)，得

(43)

證明：B恒大于零。由式(42)得

(44)

由式(28)可知

(45)

將式(45)代入式(44)，得

(46)

由上式知，對任意非零系統狀態，B總大于零。將式(44)的B移到不等號右邊，得

(47)

(48)

定理 2選恰當的系統初始狀態，使δ初始值大于零，即

δ(t0)>0

(49)

(50)

(51)

3數值計算

選系統仿真參數為：m1=10 kg，m2=40 kg,ml=2 kg，L=0.074 m,J=5 kgm,I=0.01 kgm,g=9.8 N/kg,k1=2×106N/m,k2=2×104Nm/rad。彈藥傳輸機械臂本體姿態的初始值為

(52)

設彈藥傳輸機械臂本體姿態目標值為

(53)

系統狀態與終點狀態間距離小于0.01時，認為已達到實際控制精度要求，結束計算，即

(54)

選慢時變子系統控制器參數為τ0=4 000，M=50.19；快時變子系統控制器參數為Kf=diag(200,2.6)。分別選開啟、關閉快時變子系統控制器，在MATLAB中進行兩組仿真實驗進行對比，以凸顯快時變子系統控制器對系統柔性的抑制作用。

為驗證慢時變子系統控制器對系統負載變化的魯棒性，增加一組仿真實驗，即在第二組仿真實驗基礎上，將系統翻轉部分慣量參數增加10%，而控制參數保持不變。仿真結果見圖6～圖12。各圖(a)為關閉快時變子系統控制器時，系統在其作用下位置與速度響應、跟蹤誤差與控制激勵曲線。由圖6(a)～圖9(a)可見，升降部分與翻轉部分運動曲線相對鏈條與電機輸出軸運動曲線呈規律振蕩特征，振蕩幅值隨時間歷程不斷增加，呈現繼續發散趨勢。顯然，仿真結束條件(52)永遠無法得到滿足，因此在t=0.4 s時設置主動中斷。圖10(a)、11(a)、12(a)分別為慢時變子系統控制器的控制輸入與系統Lyapunov函數時間歷程曲線。顯然，亦呈逐漸振蕩發散趨勢。各圖(b)、(c)為快、慢時變子系統控制器共同作用下系統位置與速度響應、跟蹤誤差與控制激勵曲線，圖(b)對應標稱系統，圖(c)對應慣量參數不確定系統。由圖6(b)、(c)～圖9(b)、(c)可見，升降部分與翻轉部分的振蕩迅速得到抑制，幾乎完全衰減。由圖10(b)、(c)與圖11(b)、(c)可知，系統的控制輸入曲線僅在仿真初始階段內出現短期振蕩，而系統的Lyapunov函數曲線始終單調遞減。由各圖(b)、(c)可見，標稱系統與慣量參數不確定性的響應曲線基本相似，兩者主要差別體現于總仿真時長，分別用時0.364 s、0.389 s。

圖6　升降部分位移 Fig.6 Position of the lifting part

圖7　翻轉部分角位移 Fig.7 Angle of the revolving part

圖8　升降部分速度 Fig.8 Velocity of the lifting part

圖9　翻轉部分角速度 Fig.9 Angular velocity of the revolving part

圖10　升降部分控制力 Fig.10 Control forces of the lifting part

圖11　翻轉部分控制力矩 Fig.11 Control tor que of the revolving part

圖12　Lyapunov函數值 Fig.12 Lyapunov Function

4結論

(1)針對現有坦克自動裝彈機無法實現任意角度裝填問題，提出兩自由度彈藥傳輸機械臂。該機械臂安裝于車體內部，在彈藥倉與炮尾之間，兼有任意角度協調、抓取及推送彈藥功能。

(2)鏈條與翻轉部分的減速裝置同屬驅動裝置與被驅動部件之間的傳動部件，二者柔性因素均可假設為線性無慣量彈簧?？捎玫诙怢agrange方法建立系統的剛柔耦合動力學方程。

(3)引入不同時間尺度，采用奇異攝動法將動力學模型分解為快、慢時變兩個子系統，設計出以驅動與被驅動部件速度差值為反饋的控制器及基于隱式Lyapunov函數的位置控制器。

(4)控制器表現為增益時變的PD反饋控制?？刂破髟鲆孀鳛橄到y狀態變量的可微函數，隨系統狀態變量逐漸趨于零，該增益逐漸趨于無窮大，控制力始終滿足給定約束。

(5)設計的混合控制器能克服負載變化及柔性振動影響，實現彈藥傳輸機械臂點到點位置控制及柔性振動抑制，具有較強的魯棒性。

參考文獻

[1]侯保林,樵軍謀,劉琮敏. 火炮自動裝填[M]. 北京:兵器工業出版社, 2010: 36-38.

[2]Sullivan M B. Apparatus for autoloading tank cannons[P]. U.S.:5261310, 1993-10-16.

[3]Spong M W. Modeling and control of elastic joint robots[J]. Journal of Dynamics Systems, Measurement, and Control, 1987, 109(4): 310-319.

[4]郭闖強. 空間大型機械臂關節控制系統及軌跡規劃研究[D]. 哈爾濱: 哈爾濱工業大學, 2012:16-17.

[5]Shi J X, Albu-Schaeffer A, Hirzinger G. Key issues in dynamic control of lightweight robots for space and terrestrial applications[J]. IEEE International Conference on Robotics and Automation,1998,1:490-497.

[6]郭闖強,倪風雷,孫敬颋,等. 具有力矩傳感器的柔性關節的振動抑制[J]. 機器人, 2011, 33(4): 449-454.

GUO Chuang-qiang, NI Feng-lei, SUN Jing-ting, et al. Vibration suppression for the flexible joint with torque sensor[J]. Robot, 2011, 33(4): 449-454.

[7]Ulrich S, Sasiadek J Z. Trajectory tracking control of flexible joint space manipulators[J]. Canadian Aeronautics and Space Journal, 2012, 58(1): 47-59.

[8]彭濟根,倪元華,喬紅. 柔性關節操作手的神經網絡控制[J]. 自動化學報, 2007, 33(2):175-180.

PENG Ji-gen, NI Yuan-hua, QIAO Hong. Neural network control of flexible-joint robot manipulatrs[J]. Acta Automatic Sinica, 2007, 33(2): 175-180.

[9]梁捷, 陳力. 關節柔性的漂浮基空間機器人基于奇異攝動法的軌跡跟蹤非奇異模糊Terminal滑模控制及柔性振動抑制[J]. 振動與沖擊, 2013, 32(23): 7-12.

LIANG Jie, CHEN Li. Nonsingular fuzzy terminal sliding mode control and elastic vibration suppression of a free-floating space robot with flexible joints based on trajectory tracking of the singular perturbation method[J]. Journal of Vibration and Shock, 2013, 32(23): 7-12.

[10]Shao Zhi-yu, Zhang Xiao-dong. Intelligent control of flexible-joint manipulator based on singular perturbation[A]. In: 2010 IEEE International Conference on Automation and Logistics[C]. Hong Kong and Macau, China, 2010:243-248.

[11]趙志剛. 空間站機械臂轉位控制與振動抑制研究[D]. 哈爾濱:哈爾濱工業大學, 2013:104-106.

[12]陳健康,葛連正,李瑞峰. 考慮摩擦特性的機器人柔性關節魯棒控制器設計[J]. 吉林大學學報:工學版, 2014.

CHEN Jian-kang, GE Lian-zheng, LI Rui-feng. Design of robust controller for robot flexible joint with friction characteristic[J]. Journal of Jilin University:Engineering and Technology Edition, 2014.

[13]黨進,倪風雷,劉業超,等. 基于新型補償控制策略的柔性關節控制器設計[J]. 機器人, 2011,33(1): 150-155.

DANG Jin, NI Feng-lei, LIU Ye-chao, et al. Design for flexible joint controller based on a new compensation control strategy[J]. Robot, 2011,33(1): 150-155.

[14]黨進,倪風雷,劉業超,等.一種前饋補償和模糊滑模相結合的柔性機械臂控制[J]. 西安交通大學學報,2011,5(3):75-80.

DANG Jin, NI Feng-lei, LIU Ye-chao, et al.Control strategy for flexible manipulator base on feedforward compensation and fuzzy-sliding mode control[J]. Journal of Xi’an Jiaotong Unversity, 2011, 5(3): 75-80.

[15]Chaoui H, Gueaieb W, Biglarbegian M, et al. Computationally efficient adaptive type-2 fuzzy control of flexible-joint manipulators[J]. Robotic, 2013, 2: 66-91.

[16]Anan’yevskii I M. Continuous feedback control of perturbed mechanical systems[J]. Journal of Applied Mathematics and Mechanics, 2003, 67(2): 293-305.

[17]Chernousko F L, Ananievski I M, Reshmin S A. Control of nonlinear dynamical systems：methods and applications [M]. Berlin：Springer, 2008：213-229.

[18]featherstone R, Orin D E. “Dynamics” in, handbook of robotics[M]. Berlin：Springer-Verlag Berlin Herdelberg, 2008：44.

第一作者譚儀忠男，博士生，1986年10月生

通信作者劉元雪男，教授，博士生導師，1969年生