《搬運(yùn)機(jī)器人的軌跡規(guī)劃》由會員分享，可在線閱讀，更多相關(guān)《搬運(yùn)機(jī)器人的軌跡規(guī)劃（4頁珍藏版）》請?jiān)谘b配圖網(wǎng)上搜索。

1、2010 5 :1001 ? 2265(2010)05 ? 0083 ? 03 搬運(yùn)機(jī)器人的軌跡規(guī)劃 李偉光，許陽釗 (華南理工大學(xué)機(jī)械與汽車工程學(xué)院.廣州510640) :用五段三次多項(xiàng)式方法對一種搬運(yùn)機(jī)器人的運(yùn)行軌跡進(jìn)行規(guī)劃?并利用Mathb工具對該方法進(jìn)行 仿真分析。結(jié)果表明該方法能使運(yùn)動(dòng)軌跡的位直和速度都連續(xù)?尤其是加速度也連續(xù)?并且能夠使機(jī)器 人按照規(guī)定路徑運(yùn)動(dòng)?保證機(jī)器人運(yùn)行平穩(wěn)不抖動(dòng)?順利避開障礙物?滿足設(shè)計(jì)要求。 :三次多項(xiàng)式:搬運(yùn)機(jī)器人:軌跡規(guī)劃；關(guān)節(jié)空間 :TG65; TP242 : A The Trajectory Pkinnhg of Transpo

2、rt Robot L IW ei-guang, XU Yang-zhao (School ofMechanical & Aukmotive Engineering, South China University of TechnoGuangzhou 510640, China) Abstract: Key words: ? 83 ? C 1994-2010 China Academic Journal Electronic Publishing House? All rights reserved? ki.ne( 2010 5 ? # ? C 1994-2

3、010 China Academic Journal Electronic Publishing House? All rights reserved? ki.ne( 2010 5 軌跡規(guī)劃是根據(jù)作業(yè)要求?對末端執(zhí)行器在工作 :2009- 11 - 19 :李偉光(1958?)?男?華南遑工大學(xué)教授.博士生導(dǎo)師?硏究方向?yàn)閿?shù)控技術(shù)、制造業(yè)自動(dòng)化與機(jī)電一體化?(E?maiDxuyangzhao2008^ yahoo am ciu 0 機(jī)器人軌跡規(guī)劃的研究始干20世紀(jì)60年代 末⑴?軌跡規(guī)劃大致可分為兩種：笛卡爾坐標(biāo)空間的軌 跡規(guī)劃和關(guān)節(jié)空間的軌跡規(guī)劃"I。前者雖然概念直

4、觀便于理解.可控制機(jī)器人在不同點(diǎn)沿一定的軌跡運(yùn) 行.但此方法涉及大量的笛卡爾坐標(biāo)空間和關(guān)節(jié)空間 的轉(zhuǎn)換和矩陣求逆.計(jì)算量大。而后者由于規(guī)劃函數(shù) 生成的就是關(guān)節(jié)值.可直接用于控制機(jī)器人運(yùn)動(dòng)且關(guān) 節(jié)軌跡易干規(guī)劃?有許多不同階次多項(xiàng)式函數(shù)及拋物 線過渡的線性函數(shù)來實(shí)現(xiàn)。 本文研究的5自由度搬運(yùn)機(jī)器人采用點(diǎn)到點(diǎn)控制 方法?要求完成將電徹機(jī)電議成形后高溫的蒜頭狀氣 門毛坯從電傲機(jī)取出后放入摩撩壓力機(jī)模具內(nèi)完成沖 壓成型的動(dòng)作?運(yùn)行過程要求動(dòng)作連續(xù)平滑且能夠順 利避開障礙物。為此?必須定義一個(gè)連續(xù)的且一階導(dǎo) 數(shù)和二階導(dǎo)數(shù)均連續(xù)的函數(shù)。本文釆用五段三次多項(xiàng) 式方法進(jìn)行基于關(guān)節(jié)空間的軌跡規(guī)劃。 流程中位姿

5、變化的路徑、取向及其速度和加速度變化 過程的設(shè)定?是運(yùn)動(dòng)學(xué)反解的實(shí)際應(yīng)用O 1.1 機(jī)器人運(yùn)動(dòng)路徑定義為機(jī)器人位形的一個(gè)特定序 列?運(yùn)動(dòng)路徑的定義是機(jī)器人軌跡規(guī)劃的前提。5自由 度搬運(yùn)機(jī)器人結(jié)構(gòu)包括腰部石、大臂4、小臂卜手腕4、 手指厶床端執(zhí)行器丿五部分.如圖1所示。腰部厶和手 腕人分別繞關(guān)節(jié)I和關(guān)節(jié)4做回轉(zhuǎn)運(yùn)動(dòng)，大臂4、小臂 卜手指4分別繞關(guān)節(jié)2、關(guān)節(jié)3和關(guān)節(jié)5做俯仰運(yùn)動(dòng)。 根據(jù)應(yīng)用要求定義機(jī)器人運(yùn)動(dòng)路徑如圖1所示。 機(jī)器人的運(yùn)動(dòng)過程為??沒有工作時(shí)?處于初始位直S： 工作時(shí)?沿著軌跡SA運(yùn)動(dòng)到電黴等待點(diǎn)接著進(jìn)入 如下循環(huán)由A^B,到達(dá)電徹位直?夾取蒜頭狀氣門毛 坯，?完成夾取后?

6、沿退回A點(diǎn),接著由運(yùn)動(dòng) 到摩擦壓力機(jī)模具正上方C.由CT將氣門毛坯放入 模具內(nèi)，?待氣門壓力成型完成后將氣門取走并沿D^C f4原路退回人處。本文只針對B 段的軌 跡規(guī)劃做研究。 1.2 對于段的軌跡.不僅指定了起點(diǎn)和 終點(diǎn),還指定了兩個(gè)中間點(diǎn)?為此可以通過匹配前個(gè)運(yùn) 動(dòng)段的末端與下個(gè)運(yùn)動(dòng)段的始端的位置、速度和加速 度來規(guī)劃出一條平滑連續(xù)的軌跡。利用起點(diǎn)和終點(diǎn)邊 界條件以及中間點(diǎn)的信息，可采用如下七次多項(xiàng)式來 規(guī)劃軌跡5： h =(^ +a} t +a2 f + / + a4 / +5 / + 兔 / + a： / < 1) 求解上式可得機(jī)器人運(yùn)動(dòng)軌跡，但是由于需要大 量計(jì)算且極值難

7、求?在工程應(yīng)用中很少使用該方法。 為此,可在軌跡不同的運(yùn)動(dòng)段釆用不同的低次多項(xiàng)式. 然后將它們平滑過渡地連接在一起以滿足各點(diǎn)的邊界 條件。常用4-3-4軌跡、3?5?3軌跡或三次樣條函 數(shù)軌跡等來代替高次多項(xiàng)式軌跡。由于使用4-3-4 軌跡法和3 - 5 - 3軌跡法所規(guī)劃的機(jī)器人末端執(zhí)行器 軌跡并不能按預(yù)定軌跡行走，難以避免壁碰和路障的 問題⑴.不滿足設(shè)計(jì)要求。為了使運(yùn)動(dòng)軌跡的位直、速 度和加速度都連續(xù).并且按照規(guī)定軌跡運(yùn)行?本文采用 五段三次多項(xiàng)式進(jìn)行軌跡規(guī)劃。 每段關(guān)節(jié)軌跡的三次多項(xiàng)式通式為?? hj(=(tp fa, (j- 1. 2, 3, 4, 5； (2> 式中未知系數(shù)g為

8、第丿段關(guān)節(jié)軌跡的第，個(gè)系數(shù)。 在應(yīng)用五段三次多項(xiàng)式插值時(shí)，需要有五段軌跡 和六個(gè)插值點(diǎn)。但是?在前面的討論中只有四個(gè)插值 點(diǎn).即B點(diǎn)、A點(diǎn)、C點(diǎn)和Q點(diǎn)。所以，必須選擇另外兩 個(gè)插值點(diǎn)?以便有足夠多的邊界條件求解各多頊?zhǔn)较?數(shù)?？梢栽贏點(diǎn)和Q點(diǎn)之間選取這兩個(gè)額外的結(jié)點(diǎn). 設(shè)為E點(diǎn)和尸點(diǎn)。沒有必要知道這兩個(gè)點(diǎn)的確切位 直我們只要知道時(shí)間間隔(設(shè)為1”，以及必須滿足 這兩點(diǎn)速度和加速度的連續(xù)性條件。因此.這組關(guān)節(jié) 軌跡分段多項(xiàng)式必須滿足的邊界條件是??①在〃點(diǎn)、A 點(diǎn)、C點(diǎn)和D點(diǎn)的位直約束.?②S所有插值點(diǎn)的速度和 加速度的連續(xù)性。五段三次關(guān)節(jié)軌跡的邊界條件示干 圖2中，其中有下劃線的變量為己知量

9、。 根據(jù)(2)式可得一階和二階導(dǎo)數(shù)分別為： Vj( t) 一叫;:"=知 +2“‘ + 3“0, ()- 1, 2, 3, 4, 5) ⑶ cij(t) =2^ +6^/ (j =1, 2,3,4, 5) (4) 給定了初始點(diǎn)和終止點(diǎn)的位賈、速度和加速度，第 一段軌跡和末段軌跡的多項(xiàng)式人仃丿和h,( “就完全確 定了。一且算出這兩個(gè)多項(xiàng)式，就可用位直約束和速 度、加速度連續(xù)條件求出h,(譏爪(”和九(譏 下面 以大臂關(guān)節(jié)為例?給出五段三次多項(xiàng)式軌跡的計(jì)算方 法如下?? 根據(jù)工業(yè)實(shí)際要求設(shè)定<0=05. t\ =15, Q =2s, 6 =3x 6=5se由示教可得其他巳知條件

10、如下； 6.)=113. 17： b =0.ay =0.6, =99.45： 04 =97. 86e.6$ =94?25：些=0.a5 =0 計(jì)算可得五段三次多項(xiàng)式軌跡方程為 片(/) = 1 ? 9752 ? 0?2395門0<1 (5) /i2(M= 1.7357- 0.7185(1 ? I)-0.7185(/- lP+0.7265(r- \)3 (Kt<2) (6 丿 筠(0=10252+0. 0239(t ? 2丿+1.4609"? 2)2 ? 0.7974(i ? 2廣 (7) /i4 0) = 1.7125+0. 5534 (t ? 3b 0. 9314(/- 3

11、)2 +0.3735 (t ? 3 戶 (8) hs (n =1.708 - 0. 189U? 4丿 +0. 189(/- 4)2 ? O?O63(八 4)3 對式子(5丿?(9)利用式子(3丿和式子(4丿求導(dǎo)可 得相應(yīng)的角速度和角加速度的表達(dá)式o 根據(jù)前面求解，利用mallab編寫程序可得各關(guān)節(jié) 在一個(gè)運(yùn)動(dòng)周期內(nèi)的角度、角速度和角加速度曲線。 大臂關(guān)節(jié)在MfCfD段的角度、角速度和角加速  時(shí)間t(s) 從仿真結(jié)果分析可得.大臂關(guān)節(jié)的角度變化平滑 連續(xù).與期望曲線相符。角速度和角加速度也連續(xù)無 跳變.并且加速度的變化是以線性變化的。此種插值 方法初始點(diǎn)

12、和終止點(diǎn)的速度和加速度可不為零?這就 允許再細(xì)分插值點(diǎn)和進(jìn)行過程中插值。這說明了 ?進(jìn) 行五段三次多項(xiàng)式軌跡規(guī)劃不但可以達(dá)到使機(jī)器人運(yùn) 行平穩(wěn)不抖動(dòng)的要求.而且可以按規(guī)定的路徑運(yùn)動(dòng)。 3 利用五段三次多項(xiàng)式進(jìn)行軌跡規(guī)劃能生成一條位 2、速度和加速度都連續(xù)的平滑運(yùn)動(dòng)軌跡?不但可以達(dá) 到使機(jī)器人運(yùn)行平穩(wěn)不抖動(dòng)的要求?而且可以按規(guī)定 的路徑運(yùn)動(dòng)?順利避開障礙物.滿足設(shè)計(jì)要求。 [ ] [1] 王幼民?徐蔚油 機(jī)械晉關(guān)節(jié)空間Bezier曲線軌跡規(guī)劃 [J].安徽機(jī)電學(xué)院學(xué)報(bào),2000,15(3): 59?64 [2] 陳偉華?張鐵.噴涂機(jī)器人連續(xù)直線軌跡規(guī)劃的研究卩|. 機(jī)械設(shè)計(jì)與制造.2

13、009(8): 178 - 18Q 13 ]豐天友?孟正大.趙嬌嬌?等.基于焊接機(jī)器人的關(guān)節(jié)空間 軌跡規(guī)劃方法卩]?電焊機(jī),2009(4):47 - 50 [4) 劉好明.6R關(guān)節(jié)型機(jī)器人軌跡規(guī)劃算法研究及仿直[M ]. 山東:山東理工大學(xué)?200& [5] 王曉朋?侯蝮彬?王溥.基于VC++的工業(yè)機(jī)器人軌跡規(guī)劃 研究[J].工礦自動(dòng)化.2009(5):34?37. |61漢]SacedB.Niku.普.孫富春?等?譯?機(jī)器人學(xué)導(dǎo)論—— 分析、玉統(tǒng)及應(yīng)用[M].北京：電子工業(yè)出版社.2004. [7]馬探.六自由度機(jī)械腎軌跡規(guī)劃研究[D|.哈爾濱:哈爾濱 工程大學(xué)，2007. (編輯

14、 ) ? 85 ? C 1994-2010 China Academic Journal Electronic Publishing House? All rights reserved? ki.ne( 2010 5 ? # ? C 1994-2010 China Academic Journal Electronic Publishing House? All rights reserved? ki.ne( 2010 5 IU ? $ + K

15、 圖?為方便計(jì)算將速度環(huán)部分簡化為G(S)。 系統(tǒng)傳統(tǒng)函數(shù)?? C⑸ R(S) 系統(tǒng)穂態(tài)誤差： 1 -a ? $ ? G (S) E⑸Z八C⑸一*?⑸7⑸ 由⑥式可知若I?a?$?a (S) =0.即a = ⑸時(shí)恒有E(S) =0o可見.前饋補(bǔ)償?shù)拇嬖诳?以完全消除系統(tǒng)的穩(wěn)態(tài)誤差，此時(shí)相當(dāng)于在系統(tǒng)中増 加了一個(gè)輸入信號?其產(chǎn)生的誤差信號與/HS丿產(chǎn)生的 誤差信號大小相等而方向相反。前饋補(bǔ)償裝置可以使 系統(tǒng)準(zhǔn)確無誤的復(fù)現(xiàn)控制倍號?解決了-?般反饋控制 在提髙控制精度和確保系統(tǒng)穂定性之間的矛盾9。 FANUC Oi系統(tǒng)中.在調(diào)整加工精度時(shí)通常將參數(shù) PRM2(X)5#!設(shè)為1.表

16、示前饋有效?綜合上述分析可以 消除誤差?提髙加工精度。 3 伺服系統(tǒng)的調(diào)整是一個(gè)十分復(fù)雜的過程?本文結(jié) 合控制理論和傳遞函數(shù)的分析計(jì)算?來深入理解 FANUC系統(tǒng)相應(yīng)伺服參數(shù)的調(diào)整對機(jī)床動(dòng)、靜態(tài)性能 的影響?為調(diào)試人員提供理論依據(jù)和參考?以便更好地 優(yōu)化和調(diào)整伺服性能。 ( ] I II高平生.伺服乘統(tǒng)位置增益對數(shù)控機(jī)床性能的晶響[J ]? 岳陽職業(yè)技術(shù)學(xué)院學(xué)報(bào).2009(9):88?92 12] FANUC伺服系統(tǒng)調(diào)整教材(B-IOO85CM)/O9[M ].北京 FANUC機(jī)電有限公司. 【3]張曉東?歐洲.數(shù)控悅床何服殺統(tǒng)穩(wěn)定性分析[J].機(jī)械設(shè) 計(jì)與制造.2009 (10)

17、: 201 - 20A [4]過慶琪?奚修軍.杜宏棋.班NUC何服杲統(tǒng)的遜論分析和 故障診斷[J]?基礎(chǔ)自動(dòng)化.2000(2):63 - 64 |5]金海鷹.賴彪.一種提髙伺服系統(tǒng)跟蹤性能的方法研究 [JJ.今日科苑.2009(18):277. [6|柴光遠(yuǎn).趙鵬兵.數(shù)控進(jìn)給伺服茶統(tǒng)的模糊免疫自適應(yīng)PD 控制研究[J ]?組臺機(jī)床與自動(dòng)化加工技術(shù),2009(8):74 - 77. [7]何紅欣.數(shù)控機(jī)床伺服性能的調(diào)整[J|.制造技術(shù)與機(jī)床. 2006(8): 120- 122 (編輯 ) ? # ? C 1994-2010 China Academic Journal Electronic Publishing House? All rights reserved? ki.ne(