鄒風山,曲道奎,徐 方

(1.中國科學院沈陽自動化研究所,沈陽 110016；2.中國科學院研究生院,北京 100039；3.新松機器人自動化股份有限公司,沈陽 110168)

真空機器人軌跡規(guī)劃研究*

鄒風山1,2,曲道奎1,3,徐 方1,3

(1.中國科學院沈陽自動化研究所,沈陽 110016；2.中國科學院研究生院,北京 100039；3.新松機器人自動化股份有限公司,沈陽 110168)

為了使真空機器人獲得高速、高精度的運動性能并減少系統(tǒng)的殘余振動,文中提出了一種加加速度受限的非對稱軌跡規(guī)劃方法。首先闡述了該軌跡規(guī)劃方法中軌跡限制條件的定義,然后根據(jù)定義的限制條件值給出了所有可能的加速度軌跡形狀,并給出了各種軌跡形狀下的完整算法及實現(xiàn),最后將該算法應用于真空機器人運動規(guī)劃中,該機器人用于在真空腔室中進行硅片傳輸工作。實驗結果表明該方法可以有效地提高機器人的定位精度和效率并減少系統(tǒng)的殘余振動。

點到點運動；真空機器人；軌跡規(guī)劃

0 引言

真空機器人是IC制造裝備的重要組成部分,它在加工過程中承擔硅片的傳輸和定位兩項重要的任務,它的工作速度、定位精度等直接影響硅片的生產(chǎn)效率和制造質(zhì)量。其運動要求具有小的沖擊和系統(tǒng)振動、高的定位精度和快速的定位時間。目前的主要研究問題集中在選擇合理的軌跡規(guī)劃方式及優(yōu)化參數(shù)使得系統(tǒng)在獲得高速高精度的同時盡量減少殘余振動,保證其運動過程的平滑性[1]。

在運動軌跡規(guī)劃的研究中,2階軌跡運動能獲得好的快速性,但加速度的突變?nèi)菀滓鹣到y(tǒng)振動,且難以到達高的位置精度；文獻2中采用四階規(guī)劃算法來提高系統(tǒng)的性能[2]。S.Macfarlane等提出了加加速度受限的五階實時接近最優(yōu)的規(guī)劃方法[3],采用高階的算法可以到達最小振動但除了規(guī)劃時間較長外,其運動的快速性較差；對稱S形速度軌跡因其具有運動快速性與較小的殘余振動,在許多實際工程廣泛采用[4-5]；對S形軌跡的研究焦點集中在如何在其快速性的基礎上減小系統(tǒng)的殘余振動[6]。Meckl P.H.等給出了一種加速(減速)時間的優(yōu)化方法使得系統(tǒng)具有最小振動的S形軌跡算法[7]。還有一些學者提出了兩次減速的方法,這種方法中第一步采用較大的加加速度到達接近目標點的位置,然后第二步采用較小的加加速度達到目標點,減小系統(tǒng)的振動,顯而易見的這種方法會增加執(zhí)行時間,降低生產(chǎn)效率。

在前面研究的基礎上,本文討論了一種加加速度受限的非對稱S形軌跡規(guī)劃方法,給出了一種各種軌跡形狀的完整算法,使系統(tǒng)具有一個快速的啟動和較慢速且平滑的結束,通過控制減速階段的加加速度使得系統(tǒng)在到達目標點時具有最小的殘余振動。

1 軌跡限制條件

圖1是一個典型的非對稱S曲線,根據(jù)限制條件和運動條件的不同時間段t1-t2、t3-t4和t5-t6可能不存在。首先我們假定如下的限制條件。

圖1 典型的非對稱三階軌跡

C1:時間節(jié)點t0到t7,t0表示開始時間,t7表示結束時間并且

C2:t0和t7點的加速度和速度為零

C3:P(t0)=0且P(t7)=s,s是運動距離

C4:最大速度為vm,最大加速度amu,最大減加速度amd

C5:,加速段最大加加速度jmu,減速段最大加加速度為jmd

C6:tjd=Rtju,tad=Rtau,R為可調(diào)節(jié)的參數(shù),當R=1時,規(guī)劃的軌跡為對稱的S曲線。

2 算法實現(xiàn)

2.1 特征條件值的定義與計算

(1)當加速度達到最大值時,對應的速度和距離定義為:v_au和s_au

(2)減速過程中,當減加速度達到最大值時,對應的速度和距離定義為:v_ad和s_ad

(3)當速度達到最大值時,加速段運動距離與減速段運動距離的和為:

(4)Amu,Jmu,Amd,Jmd之間的關系

由假設條件

t7點的速度為零,我們可得出

將(1)、(2)帶入(3)可得到如下關系:

2.2 加速度軌跡形狀與公式推導

算法的關鍵是計算時間節(jié)點tjutautvtjd和tad,根據(jù)上面的條件,對于不同的限制條件可分為以下四種情況:

(1)vm≤v_au且s＞s_v_1

加速軌跡為三角形且正負不相連,運動中可以達到最大速度,但不能到達其最大加速度tju和tjd由最大速度vm確定,tv由運動距離s確定。我們可得到以下公式:

圖2 加速度軌跡

(2)vm≤v_au且s＜s_v_1或vm＞v_au且s≤s_au+s_ad

加速度軌跡為三角形且正負相連,運動中不能達到最大加速度也不能到達最大速度,tju和tjd由運動距離s確定運動距離可表示為:

將 (2)和 (4)帶入 (5)可得如下計算:

圖3 加速度軌跡

(3)vm＞v_au且s_au+s_ad＜s≤s_v_2

加速度軌跡為梯形且正負相連,軌跡可以到達其最大加速度與最大減加速度,但不能到達最大速度,這種情況下運動距離可表示為:

圖4 加速度軌跡

從上式可得:

(4)vm＞v_au且s_v_2 ＜s

加速度軌跡為梯形且正負不相連,最大速度和最大加速度都可以達到。

圖5 加速度軌跡

3 實驗結果

實驗用的真空機器人有三個自由度,分別是上升、旋轉和伸縮,各軸均采用AC伺服電機驅(qū)動。算法中的參數(shù)R可以根據(jù)需要選擇,當R=1時,規(guī)劃方式變?yōu)閷ΨQ的軌跡規(guī)劃,試驗中讓機器人分別以T型規(guī)劃、S型規(guī)劃(R=1)、非對稱S規(guī)劃(R=2)及非對稱S規(guī)劃(R=1.5)四種軌跡以相同的參數(shù)運行,比較其系統(tǒng)的性能。選取如下的運動參數(shù):動距離為120°,最大速度 180 °/s,最大加速度800°/s2,最大加加速度8000°/s3。

實驗結果如圖6 ～9和表1所示,從位置誤差和振動上來看,相比于傳統(tǒng)的規(guī)劃方法,這中非對稱的規(guī)劃方法可以獲得較小的位置誤差和較低的系統(tǒng)振動,一般R越大,越有利于減少系統(tǒng)振動,但并不完全是這樣,這主要是由于振動還跟機器人的固有頻率有關。從運動時間上來看,盡管非對稱規(guī)劃的時間要長,但其穩(wěn)定時間明顯要短,所以整個系統(tǒng)運動時間(包括運動時間和定位時間)較短,適當選擇R的值可以優(yōu)化機器人的運行軌跡。

圖6 二階軌跡規(guī)劃方法的位置誤差

圖7 三階對稱軌跡規(guī)劃的位置誤差

圖8 非對稱軌跡規(guī)劃的置誤差(R=1.5)

圖9 非對稱軌跡規(guī)劃的位置誤差(R=2)

表1 實驗結果比較

4 結束語

本文針對真空機器人高速、高精度和低振動的工作特點,在分析各種軌跡規(guī)劃方法的基礎上,研究了一種非對稱S軌跡規(guī)劃算法,并給出了各種加速度軌跡形狀下的計算公式。實驗結果通過調(diào)整規(guī)劃參數(shù)R,可以有效地控制系統(tǒng)殘余振動的發(fā)生,提高系統(tǒng)的定位效率。

[1]H.Z.Li,Z.M.Gong,and T.Lippa,"Motion Profile Planning for Reduced Jerk and Vibration Residuals,"SIMTech technical reports,2007,8(1):32-37.

[2]穆海華,周云飛,等.超精密點對點運動4階軌跡規(guī)劃算法研究[J].中國機械工程,2007(19):2346-2350.

[3]S.Macfalane,E.A.Croft,"Jerk-Bounded Manipulator Trajectory Planning:Design for Real - Time Applications," IEEE Trans. on Robotics and Automation,2003,19(1):42-52.

[4]賈松濤,朱煜,等.超精密工作臺運動軌跡規(guī)劃[J].組合機床與自動化加工技術,2007(4):14-16.

[5]陸蓮仕,潘海鴻.具有恒定速度段的點到點運動的軌跡規(guī)劃[J].組合機床與自動化加工技術,2006(5):8-10.

[6]K.D.Nguyen,T.C.Ng and I.M.Chen,"On Algorithms for Planning S-cruve Motion Porfile,"Int.Journal of Advanced Robotics System,2008,5(1):99-106.

[7]P.H.Mechl,P.B."Optimized S-Curve Motion Profiles for Minimum Residual Vibration,"Proc.of the American Control Conference, Philadelphia,Pennsylvania,June 1998:2627-2631.

Research on Vacuum Cluster Tools Robot Trajectory Planning

ZOU Feng-shan1,2,QU Dao-kui1,3,XU Fang1,3
(1.Shenyang Institute of Automation,Chinese Academy of Science,Shenyang 110016,China；2.Graduate School of Chinese Academy of Sciences,Beijing 100039,China)

In order to obtain high-precision and high-speed motion and reduce the residual vibration for vacuum robot,an asymmetric trajectory planning method with jerk bounded is presented.Constraints of the trajectory are firstly analyzed.And then according the definition of limitation values,all possible profile shapes are discussed.The algorithm and its implementation are proposed with a direct and complete method.At the end,we apply the proposed approach to high-precision vacuum cluster tool robot which is used in the vacuum chambers for handling semiconductor wafer.Experimental results show that the proposed method can improve the positioning accuracy and efficiency and reduce the residual vibration.

point-to-point motion；vacuum robot；trajectory planning

TH16；TG65

A

1001-2265(2011)10-0013-04

2011-03-07；

2011-05-25

國家科技重大專項(2009ZX02012)

鄒風山(1978—),男,山東泰安人,中國科學院博士,主要從事機器人控制與應用研究,(E-mail)llzfs@126.com

(編輯 李秀敏)