基于期望軌跡非線性補償?shù)臋C械臂控制器設(shè)計

崔敏其，李杞儀，陳偉華

(1.華南理工大學廣州學院工程研究院，廣州 510800;2.香港中文大學 機械與自動化工程學系，中國香港)

基于期望軌跡非線性補償?shù)臋C械臂控制器設(shè)計

崔敏其1，2，李杞儀1，陳偉華1

(1.華南理工大學廣州學院工程研究院，廣州 510800;2.香港中文大學 機械與自動化工程學系，中國香港)

基于期望軌跡非線性補償方法是一種在機械臂伺服控制律的增加非線性補償項，用于抵消機械臂動力學的非線性項的一種機械臂控制方法。首先，給出機械臂動力學方程的一般形式及其分析。然后詳細介紹基于期望軌跡非線性補償方法的控制原理，并給出其控制律的數(shù)學描述以及閉環(huán)動力學方程。討論基于期望軌跡非線性補償方法控制器的優(yōu)點，并使用李雅普諾夫方法以及LaSalle定理對控制器的穩(wěn)定性進行證明。最后，使用基于期望軌跡非線性補償方法的控制律，對PUMA560型機械臂的前三關(guān)節(jié)進行正動力學仿真，并給出仿真結(jié)果。

機械臂控制器;非線性補償法;動力學分析;工業(yè)機器人

0 引言

隨著機械臂廣泛應用于加工制造業(yè)，使得行業(yè)的制造效率和制造精度大幅的提升。得益于非線性控制理論研究的深入，人們開始掌握越來越高級的機械臂控制技術(shù)，基于非線性理論設(shè)計出來的機械臂控制方法，如計算力矩法(Computed Torque Method)等，可以較好地提高機械臂的控制水平。

然而，非線性系統(tǒng)問題的求解十分復雜。因此我們可以將非線性系統(tǒng)給予線性化，來簡化控制問題或控制算法。一般地非線性系統(tǒng)線性化有如下方法:①非線性特征不明顯的，可以局部線性化導出線性模型;②建立線性時變系統(tǒng)，始終在操作臂期望位置附近進行線性化;③在伺服控制律增加非線性補償項，用于抵消被控系統(tǒng)的非線性［1］。本文介紹的控制器正是基于方法③原理，使用機械臂的期望軌跡來設(shè)計非線性補償項的一種機械臂非線性控制器——基于期望軌跡的非線性補償法(Nonlinear Compensation Using Desired Trajectory Method)。

1 機械臂的動力學問題

一般地，機械臂的剛體動力學方程較為復雜，為了便于討論，下面給出對機械臂動力學方程的一般形式:

2 基于期望軌跡的非線性補償法

在機械臂軌跡跟隨(trajectory tracking)控制中，非線性的慣性力、離心力和科氏力對控制的影響很大。因此在設(shè)計控制器的時候，在控制律上增加對他們的補償項，從而抵消其對系統(tǒng)的非線性影響，這是本控制方法的設(shè)計關(guān)鍵。

本控制方法的優(yōu)點:

(1)使用已知的機械臂期望運動軌跡，可以對機械臂動力學方程中的非線性力進行補償;

(2)因為本方法各補償項均為已知，因此補償項的計算可以離線進行。換而言之，補償項的計算可以在機械臂運動之前完成計算。例如預先計算控制律中的補償項;并將結(jié)果存儲在表格內(nèi);實時控制的時候，只需計算運算量十分低的－K1Δ(t)－K2Δq(t)項，并查閱記錄在表格中的補償項的值，然后相加即可得到伺服值τ;

(3)本控制器具有局部漸近穩(wěn)定性。下面使用李雅普諾夫方法進行證明:

假定選取李雅普諾夫函數(shù)

3 仿真

下面使用基于期望軌跡的非線性補償法對PUMA560機械臂［2］第一、二、三關(guān)節(jié)進行軌跡跟隨控制。由軌跡生成器生成PUMA機械臂前三關(guān)節(jié)的期望軌跡(desired trajectory):

仿真結(jié)果如圖1所示。圖1a反映了在本文所述控制器的控制下，PUMA機械臂前三關(guān)節(jié)的跟隨情況。圖上實線代表的是期望軌跡，虛線代表機械臂實際跟隨軌跡?？梢姡藱C械臂啟動后的第一個1/4周期有稍微偏差外，期望軌跡和實際軌跡基曲線基本重合。也就是說，本控制器有較好的軌跡跟隨效果。圖1b是對軌跡跟隨效果進行量化描述，即分析機械臂關(guān)節(jié)角的實時跟隨誤差Δq(t)=q(t)－qd(t)。分析圖像，誤差曲線具有較好的漸近穩(wěn)定性。此處機械臂三個關(guān)節(jié)都使用了一樣的控制參數(shù)(K1=5，K2=100)，關(guān)節(jié)三的負載最小，相比關(guān)節(jié)一、二有更好的跟隨效果。實際上，機械臂各關(guān)節(jié)的控制參數(shù)均可以單獨設(shè)置，選取合理的控制參數(shù)，關(guān)節(jié)一、二也可以實現(xiàn)關(guān)節(jié)三的跟隨效果。

圖1 PUMA560型機械臂仿真效果

4 結(jié)論

基于期望軌跡非線性補償方法使用已知的機械臂期望運動軌跡，對機械臂所受到的非線性力進行補償，補償項的計算可以離線進行，可以較好減少控制系統(tǒng)實時運算量。結(jié)合PUMA560仿真結(jié)果分析，本控制器具有較好的軌跡跟隨效果以及較好的漸近穩(wěn)定性。

［1］J.J.Craig，Introduction to Robotics:Mechanics and Control［M］.3rd ed.Upper Saddle River，N.J.:Pearson/Prentice Hall，2005:62 －89.

［2］B.Armstrong，O.Khatib，and J.Burdick，“The explicit dynamicmodel and inertia parameters of the Puma60 arm”，in Proc.IEEE Int.Conf.Robotics and Automation，vol 1，(San Francisco，USA)，pp.510－8，1986.

［3］F.L.Lewis，C.T.Abdallah and D.M.Dawson，Control of Robot Manipulators［M］.New York:Macmillan Pub.Co.，1993:64 －90.

［4］B.Armstrong，O.Khatib，and J.Burdick“The Explicit Dynamic Model and Inertial Parameters of.

［5］S.M.Megahed，Principles of Robot Modelling and Simulation［M］.Chichester;New York:J.Wiley，1993:186－191.

［6］ H.M.Choset，Principles of Robot Motion［M］.Cambridge，Mass.:MIT Press，2005:349 －372.

［7］ H.Josephs and R.L.Huston，Dynamics of Mechanical Systems.Boca Raton:CRC Press，2002:415 －418.

［8］謝存禧，張鐵.機器人技術(shù)與應用［M］.北京:機械工業(yè)出版社，2005.

［9］Ferdinand P.Beer，E.Russell Johnston，David F.Mazurek ect.，Vector Mechanics for Engineers:Statics and Dynamics［M］.9nd ed.Boston:McGraw －Hill Higher Education，2011:914－998.

［10］譚曉東，劉鑫，趙巖.PUMA-560機械手虛擬裝配過程中的視覺分析和變換計算的研究［J］.組合機床與自動化加工技術(shù)，2010(1):27－31.

(編輯 趙蓉)

Design of Manipulator Controller Based on Nonlinear Com pensation Using Desired Trajectory

CUIMin-qi1，2，LIQi-yi1，CHENWei-hua1
(1.Engineering Research Institute，Guangzhou College of South China University of Technology，Guangzhou 510800，China;2.The Department of Mechanical and Automation of Engineering，The Chinese University of Hong Kong，Hong Kong，China)

Nonlinear compensation using desired trajectory controlmethod is amanipulator controlmethod designed for compensating the nonlinear terms of manipulator dynamics.Firstly，the paper provides the general form ofmanipulator dynamics equations.Then，describes the control theory of the nonlinear compensation using desired trajectory controlmethod.Control law and close-loop dynamics for the controlmethod are given.After that，the paper discusses the advantages of this controlmethod，and proofs its stability with Lyapunov Theorem and LaSalle Theorem.Finally，the paper shows the result of forward dynamics simulation for PUMA560 controlled by thismethod.

manipulator controller;nonlinear compensation method;dynamics analysis;industrial robot

TH113;TG659

A

1001－2265(2013)11－0058－03

2013－03－04;

2013－04－06

崔敏其(1987—)，男，廣州人，華南理工大學廣州學院教師，香港中文大學碩士研究生，研究方向為機器人技術(shù)及應用，(E－mail)mqtsui@foxmail.com。