氣動機械手升降臂結(jié)構(gòu)設(shè)計
氣動機械手升降臂結(jié)構(gòu)設(shè)計,氣動機械手升降臂結(jié)構(gòu)設(shè)計,氣動,機械手,升降,結(jié)構(gòu)設(shè)計
附件1基于路徑幾何約束的高效機械手控制算法Kang G. Shin and Neil D. McKayDepartment of Electrical and Computer EngineeringThe University of MichiganAnn Arbor, Michigan 48109摘要:傳統(tǒng)上,機械手控制運算法則被區(qū)分為兩級,即路徑規(guī)劃和路徑跟蹤(或路徑控制)。這種劃分方法已經(jīng)被主要地應(yīng)用于減輕復(fù)雜連結(jié)的機械手動力學(xué)。不幸的是,這種簡單的劃分方法是以犧牲機械手的工作效率為代價的。為了改善這種低效率的情況,本文認為要使機械手在最短時間內(nèi)沿著一條指定的幾何路徑移動受到輸入扭矩/扭力的限制。我們首先采用幾何學(xué)路徑約束引入避免碰撞和操作需求的變量函數(shù)來描述機械手動力要求,然后將輸入扭矩/扭力的限制參數(shù)轉(zhuǎn)變成這些變量。最后最短時間的求解就可用相平面技術(shù)進行推導(dǎo)運算求解。1、前言在過去的幾年人們主要關(guān)注于工業(yè)自動化技術(shù),尤其是使用通用機器人技術(shù)。由于工業(yè)機器人的目的是為了提高生產(chǎn)力,如何使每1美元的機器人控制投入獲得盡可能多的效益成為越來越突出的問題。通常固定成本在生產(chǎn)項目成本中占主導(dǎo)地位,所以人們總希望在給定的時間中生產(chǎn)盡可能多的產(chǎn)品。有多種算法可用于最短時間或接近最短時間機械手控制運算。這些算法通常劃分為兩個層次。第一個層次是所謂的路徑規(guī)劃,第二個層次是所謂的路徑跟蹤或路徑控制。通常路徑控制的定義是企圖實現(xiàn)讓機器人的實際位置和速度匹配理想的位置和速度。這種控制用控制器來實現(xiàn)。控制器接收上一次計算的理想位置值與速度值進行路徑位置描述,然后通過路徑跟蹤系統(tǒng)跟蹤機械手實際位置和速度得到運動偏差。這樣分開控制方案是基于機械手控制程序,如果把控制作為一個整體考慮將會非常復(fù)雜,由于幾乎最簡單的機械手的動力學(xué)之后是高度地非線性甚至更復(fù)雜。把控制分為兩部分來分別處理使得整個控制過程變得簡單。路徑追蹤通常是一個線性的控制算法,機械手動力學(xué)的非線性在這一個水平時常不被考慮,如此的追蹤控制通常能得到需要的軌道并使機械手運動與實際要求保持非常接近。使得精密加工得以實現(xiàn),例如解析運動速度控制(參考文獻1 ) ,突然的加速度控制(參考文獻2 ), 及斷續(xù)速度變化控制(參考文獻3-5 )。不幸的是,單純地劃分為路徑規(guī)劃和路徑追蹤是以犧牲效率為代價的。效率低下的根源是路徑規(guī)劃,為了提高機械手的效率,路徑規(guī)劃時必須了解該機器人的動態(tài)特性,以及準確的動態(tài)模型。然而,規(guī)劃運算法則的大部份的路徑計算只與數(shù)據(jù)計算有關(guān),有關(guān)機械手的動力學(xué)計算非常少。通常假定機械手的速度和加速度為恒定或按一定規(guī)律變化的(參考文獻6,7),并具有一定的區(qū)域邊界約束。事實上,這些約束因位置,負載大小,甚至隨有效載荷面積而改變。因此為了使邊界約束為有效的恒定值,速度面積法的邊界取值必須是速度和加速度的整體最低值;換句話說,對于最壞情況的限制必須有效。由于機械手關(guān)節(jié)處的轉(zhuǎn)動慣量加速度有限制,可能被三個或更多的條件所約束,這些多出的約束造成機械手的效率低下。為了提高效率,本文提出了一種依據(jù)幾何路徑和輸入扭矩/扭力上的最短時間機械手路徑控制解決方案,方案以路徑運算法則的方式加入機械手動力學(xué)運算。路徑規(guī)劃輸出真實的最短時間,作為其它可被測量的路徑規(guī)劃的測量標(biāo)準。注意,本文提到的問題和解決辦法與參考文獻 8,9 中的接近最短時間控制理論不同。本文分為五個部分分別論述,第二部分描述了使機械手輸入扭矩的動態(tài)約束方程更易于處理和控制的方法;第三部分考慮公式化時間控制的細節(jié)問題;第四部分用狀態(tài)平面的技術(shù)求解最優(yōu)解;第五部分是本文亮點,推導(dǎo)產(chǎn)生最佳的運動軌跡的運算法則;最后部分是該方法則使用意義討論。2、機器人動力學(xué)與約束在進行最短時間控制問題研究前,先考慮對系統(tǒng)的行為進行控制,即機器人的手臂動力學(xué)模型。有多種方法獲得的機器人臂的動力學(xué)方程,即方程中有關(guān)位置處的綜合力和扭矩,速度扭矩和加速度。最常使用的兩種方法是拉格朗日和牛頓、歐拉公式。牛頓、歐拉公式雖然計算效率高,但卻很難用于控制問題的遞推計算。拉格朗日雖然計算效率不高,但確實產(chǎn)生一組非常適用于機械手控制問題的微分方程式。在這里動力方程僅用于獲得分析結(jié)果,我們使用拉格朗日的方法得出以下機械手動力學(xué)方程(參考文獻12,13)。qi=vi (1a)ui=Jijqvj+Rijvj+Cijkqvjvk+Giq (1b)式中 qi=ith 廣義坐標(biāo) vi=ith 廣義速度 ui=ith 廣義力 Jij= 慣性矩陣 Gi = 在 ith 加上重力的力 Cijk= 科氏陣列 Rij= 粘性摩擦矩陣愛因斯坦求和約束的使用使所有指數(shù)從1到n包含在n自由度機器人中。慣性矩陣Jij的比例常數(shù)是施加于ith的總的扭矩/扭力與Jij上的總加速度??评飱W利數(shù)列描述了結(jié)合 j 和 k 的速度進入Cijk的力。粘性摩擦矩陣R給出由于速度 j 產(chǎn)生的 i 而受到的摩擦力。注意這個矩陣為對角矩陣,所有輸入數(shù)值無負值。機器人的手臂運動當(dāng)然不會完全不受約束。事實上,在關(guān)節(jié)處機器人手臂必須限制在一個固定的空間運動,且運動軌跡為給定的參數(shù)化曲線。曲線被由參數(shù) 的n個函數(shù)集決定,所以我們有qi=fi , 0max (2)其中為理想軌跡的一個參數(shù),當(dāng)從 0 到max變化時坐標(biāo) qi 也連續(xù)地變化且路徑不重復(fù),即0=0 ,tf=max .應(yīng)當(dāng)指出,在實際空間的運動軌跡是建立在笛卡爾坐標(biāo)上。一般很難把曲線從笛卡爾坐標(biāo)完全轉(zhuǎn)換到機械臂關(guān)節(jié)空間坐標(biāo)中,相對地執(zhí)行單個點的轉(zhuǎn)換卻很容易。在笛卡爾的路徑上拾足夠多的點進行坐標(biāo)變換,利用插值法技術(shù) (例如 三次樣條函數(shù))獲得機械臂關(guān)節(jié)空間的一個相似的軌跡。(見10為一個例子)回到之前的問題,我們用時間來區(qū)分參數(shù)化的qi 得到 其中 = 運動方程沿著曲線(Le幾何學(xué)的路徑)變成注意,如果表示沿著路徑的弧長,那么和分別表示沿著路徑的速度和加速度?;谶@種參數(shù)化有兩個狀態(tài)變量,即和,但有(n + 1)個方程。選擇方程=和剩余方程序之一為狀態(tài)方程,其他方程作為輸入 的約束。將ith乘以dfi()d 就可以從給出的n個方程中得到一個狀態(tài)方程這個公式有個明顯的優(yōu)點,在約束函數(shù)導(dǎo)出的向量中參數(shù)是二次的,當(dāng)一階導(dǎo)數(shù)存在時曲線可以進行參數(shù)化,且慣性矩正定,整個的方程能被正的、非零的參數(shù)分開,由和得到的一個解?,F(xiàn)在得到二個狀態(tài)方程,而最初的n個方程則由輸入和 約束(關(guān)于這方面將在后面討論)。 通過變換,狀態(tài)方程變?yōu)楝F(xiàn)在考慮由|ui|umaxi和公式(4a)限制的約束,動態(tài)方程(4a)可以寫成這樣的形式:ui=gi()u+hi(,). 對于一個給定的狀態(tài),也就是給定的 h 和,u,這是一個參數(shù)p的一組線性參數(shù)方程,約束存在于輸入變化區(qū)間及因輸入變化形成的約束矩陣中。因此把矩陣約束在u上,通過方程參數(shù)使輸入扭矩/扭力變化的所有位置、速度在路徑上彼此限制,給出初始的(,)及u的大小,如果知道機械手關(guān)節(jié)處的輸入扭矩、扭力這樣就能用數(shù)的處理來代替n個矢量的處理進而得到一系列的約束(路徑狀態(tài)方程)。因為性能完全由u決定,我們用-umaxiui+umaxi于是有:簡化:于是得到:注意:前面的方程都是的函數(shù),為了簡化計算,功能的依賴性在下面的計算不再指出。給出的控制不等式:另一種格式:LBiuUBi,這些參數(shù)由n決定,u滿足:maxLBiuminUBi 或者GLB(,)uLUB(,) (7e)路徑計劃要呈現(xiàn)的運算法則與之前依照慣例得到方程的不同,可知參數(shù) 是笛卡爾的空間的弧長,是速度,是幾何加速度。傳統(tǒng)路徑規(guī)劃把加速度劃分為幾個常數(shù)間隔,于是:GLB(,)uminuumaxLUB(,)式中umin 和 umax是常數(shù)。傳統(tǒng)方法把加速度進行了過多的約束,使速度也有過多的約束。3、最佳控制問題的公式化現(xiàn)在我們得到根據(jù)幾何路徑和輸入系統(tǒng)規(guī)定參數(shù)的機械手動力方程,就可以分析實際控制問題了。機械手控制的目的是以最小的輸入得到最大的動力輸出,這可以用最佳控制語言來描述,常用的方法使龐特里亞金最大值原理11。最大值問題即點的連接問題,除了一些簡單的點不能使用閉環(huán)控制,而且很難以數(shù)字的方式解決。我們使用最大值原理獲得加工質(zhì)量而不僅僅是獲得方程的解,這個解將用于之后的最小時間求解。考慮實際情況,最低成本即最短加工時間,就是求機械手運動最大速度,可以表示為:C=0tf l dt (8)這里tf由電子激光器決定,價值函數(shù)C必須服從下面給出的3個約束:機械手的動力微分方程約束(即式(6a),(6b));輸入量要求,關(guān)節(jié)驅(qū)動器輸入扭矩允許范圍要求(即|ui|umaxi);第三個參數(shù)是空間參數(shù)設(shè)置,機械手運動到達指定工位不能與如何物體相碰。假定理想的幾何方程已經(jīng)把最小時間控制參數(shù)化,就像之前希望的(即等式(3),但最初的點為=0,結(jié)束點為=max且dfid存在,這樣保證(6a),(6b)存在,同時當(dāng)從0到max方程是單調(diào)的。把這些代入動力方程,我們得到如下的最短時間方程(簡稱MTPP)。MTPP:求出x0=0,0和ui0 通過將式(8)代入(6a),(6b), |ui|umaxi ,及邊界條件0=0 , tf=f (9a)0=0 , tf=max (9b)3.1、最大原則的應(yīng)用為了使0max需要增加一個第三個狀態(tài)方程,第三狀態(tài)v,并要求:v=2l-+max-2l-max (10)其中:lx=1 (x0) 0 (x0) v0要求邊界約束v0=vtf=0這樣v無限接近0,當(dāng)在0max中間隔取值使v無限接近0。在對狀態(tài)方程進行變化前,先定義函數(shù):這樣就可以簡化公式,得到:區(qū)間M表示機械手功能的二次形式,如果把參數(shù)qi加入到動能方程,得到K=M2/2 ;Q表示科里奧利的組成和沿著路勁加上參數(shù)化的地心引力;區(qū)間R表示摩擦力,S給出沿著路勁的地心引力,U表示輸入重力區(qū)間。 之前的MTPP可以這樣變化將(8)代入(11a),(11b),(11c),(7d),(9a),(9b)求y0=0,0,v0和U0的極小值,通過MTPP變換哈米爾頓函數(shù)變?yōu)椋夯蚴褂们懊娴奶鎿Q得到哈米爾頓函數(shù)對求導(dǎo),對求導(dǎo),最后對v求導(dǎo),應(yīng)用最大值原理,我們需求出H在(12b)中的最小值,聯(lián)合各式(11a),(11b),(11c),(9a)及(7b),且H必須滿足邊界條件。這里y是矢量(,v)的狀態(tài)向量,我們得到一個簡單的輸入?yún)^(qū)間 在式(14)中知道H不明確依賴t,也可以看作 是由約束(9)和vtf=0得到。注:哈米爾頓函數(shù)(12b)在U上線性,且由于ui和dfid在0,max有界使得U有界,這就要求U的最優(yōu)解必須滿足繼電氣控制邏輯,在最優(yōu)軌跡上任意點的式(12b)中U的解是U的最大或最小值,通過對ui求導(dǎo)得到U的極值,關(guān)于ui的等式約束為ui=gi()+ hi (,),得到由于U的繼電器控制和給定的參數(shù)(,)U的大小線性地跟隨,也必須滿足繼電氣控制邏輯。因此等于GLB(,)或LUB(,)。再考慮三維空間,作用于不均等加工時輸入等式約束線上一點,如果 ith 的聯(lián)合輸入在約束的一邊慢慢趨近于最大值,將推使機械手向正方向推動。無論輸入的系數(shù)是否為零以上的推論都成立,即p2在(13a)中不為0。如果p2只在孤立的點處為0,則得到各處的最佳控制。另一方面,如果p2在某些區(qū)間內(nèi)為0,我們有下列的定理。定理1:如果p2在區(qū)間t1,t2 (t1S0Umin(0) 則p2(0)0 ;證明:已知0max則當(dāng)t=tf有0,又tf=0,則當(dāng)ttf時(t)max。但在tf處tf=M-1U-S0于是U-S0,矛盾,故有p2(tf)0;確定p2(0)的符號及(0)的大小,同理可得00 ,則U-S0,使用繼電器控制于是有U=Umax否則 U=Umin且Umin-S0,但如果U=Umax則p20,于是p2(0)0.這些理論的一個重要原則是開關(guān)點個數(shù)為奇數(shù),如果開關(guān)點個數(shù)為偶數(shù),p2(tf)的符號將和p2(0)的符號相同,則sinp2tf=(-1)msin( p20)其中m為符號變化次數(shù)。4、相平面解釋在相位平面中審查系統(tǒng)行為,相位平面軌跡的方程由方程(11 b )及(11 a)獲得有趣的是整個時間T從開始到結(jié)束可以寫為然后將得到給定的整體最小參數(shù),這就希望越大越好。參數(shù)有兩個影響因數(shù):運動軌跡的斜率和值的大小。用除以得到dd= ;為了得到就必須考慮的范圍,通過和的特征值,我們有LUB(,)0且20,則在區(qū)間1,2至少存在一個零點。證明:如果g( )的微分在區(qū)間1,2連續(xù),那么一定存在一個零點。如果g( )不連續(xù),假設(shè)不存在零點,則在g( )溢出區(qū)間存在一個或更多的點,符號變化發(fā)生于這一個或更多的這些點。如果不是這樣,那么在g( )存在一個符號變化的點使g( )微分連續(xù),而且因此會有一個零點。兩個限制參數(shù)記為g1,g2;g1作用于d,由lim0lim有對于0我們有代入約束,由g( )=min gi( )得g1 d+ di的約束解,和假設(shè)矛盾。這樣至少存在一個點使為零。這一個定理的圖解意義在圖 7 說明。從圖中看出, g( )一定超出區(qū)域,且是分段連續(xù)的,曲線向上跳躍。證明完畢。為了要證明ACOTNF 結(jié)束,我們對函數(shù)fi() 進行一些假設(shè) ,假設(shè)fi可分段求解且由有限個不含實際價值的數(shù)組成。非正式地,因為慣性矩陣,科里奧利數(shù)列,重力加速度等是全局解析函數(shù),而且自從路徑被限制之后是分段求解的,我們已經(jīng)處理的所有函數(shù)也是分段求解的,函數(shù)也是分段求解的,于是將會因此在每個區(qū)域中產(chǎn)生一個零點或有限個零點。如果間隔地為0,軌跡將沿著邊界停止在間隔結(jié)束的地方,相同的零間隔不會引起問題。只有間隔的最右面點可能是一個交換點,因此只有如此有限的間隔會引起ACOTNF 有限的反復(fù)。如此收斂被保證,因此有限數(shù)目的解域我們有下列的定理:定理3b:如果函數(shù)fi有有限個實際價值解,那么函數(shù)存在一定數(shù)量的間隔結(jié)束于區(qū)域外的零。證明:慣性矩陣,科里奧利陣列,重力加速度在 qi 中分段解,fi在處的解等等作為函數(shù)(就像公式(4a)和(4b))的分段解或有限的單解。公式(7b)中的M,Q,R,S也是單個的解。一個在有限區(qū)間內(nèi)沒有奇點的實際價值的解析函數(shù),一定存在有限個零點或同一零點,工程量M必須在區(qū)間內(nèi)為零。如果假設(shè) 我們可以得到所有的Mi零點。如果其中一個Mi不為零,就不存在邊界曲線,就沒有零點。只要有兩個或更多不為零的點,就可得到邊界曲線。坐標(biāo)i,j代入式(17b)(用=代替)得到曲線,式(17b)中系數(shù)A,B,C,D排除在Mi中的零之外,由于Mi存在零點,考慮用Mi中的零點進行區(qū)間分割。在每個小區(qū)間內(nèi),只有一個(17b)方程有效。在區(qū)間內(nèi)是的一個解,邊界曲線g( )是特解,也是特解且在每個區(qū)間內(nèi)存在一個或數(shù)個零點。由于在區(qū)間內(nèi)存在一個或數(shù)個零點,因此區(qū)間個數(shù)是有限的,且結(jié)束于區(qū)域外的零。證明完畢。定理4:由ACOTNF產(chǎn)生的任何軌跡在最短時間控制上是最優(yōu)的。證明:該定理的證明是直接證明。假設(shè)一個軌跡比由ACOTNF算法產(chǎn)生的軌跡有更小的運動時間。由等式(8)可知,必然存在使新軌跡上的點(,)高于ACOTNF軌跡上的點(,),即。否則,就不存在一個運動時間更短的軌跡。我們根據(jù)最大原則分析可知解不唯一,即存在數(shù)條最大加減速曲線,所以我們只能應(yīng)用那些不確定的軌跡?,F(xiàn)在有四種可能,(,)可能位于ACOTNF軌跡初始的加速段,也可能位于最后的減速段,也有可能位于其他的加速或減速軌跡上。在第一種情況下,新軌跡的初始值必須大于ACOTNF的初始值。否則,新的軌跡必須在某些點上具有比ACOTNF更大的加速度,而這是不可能的,因為ACOTNF軌跡擁有可允許的最大加速度。新軌跡因此就可能達到合適的臨界條件。第二種情況與之類似。因為(,)點在ACOTNF軌跡上,新軌跡必須比擁有最大的減速度的ACOTNF軌跡減速更快才能達到相同的臨界條件。這也是不可能的,因為ACOTNF使用最大的減速度。在第三種情況下,(,)在其他的加速軌跡上,在這種情況下,通向(,)點的軌跡必須移出可行域的邊界。否則,這些軌跡必須通過ACOTNF軌跡的加速階段,因為它們通過邊界上的一個點。新軌跡在該相交點的加速度將大于ACOTNF的軌跡,同樣,這也是不可能的。最后一種情況與前者類似。從(,)出發(fā)的加速或者減速軌跡必須要么與可行域的邊界相交,要么比ACOTNF減速軌跡減速快,因此,無解。證明完畢。這種產(chǎn)生最優(yōu)軌跡的方法可以在相位平面內(nèi)任何有可行域的情況下工作,而不只是無摩擦的情況?;舅枷胧菬o限接近可行域的邊緣而不超出它。因此軌跡僅僅是沒有接觸到非可行域。在實際中這當(dāng)然會很危險,因為控制系統(tǒng)輸入和測試系統(tǒng)參數(shù)的小錯誤都將很可能使機器人偏離預(yù)定的軌跡。然而從理論上說,這個軌跡是最節(jié)約時間的。我們現(xiàn)在考慮一般的情況,即摩擦力足以使相位平面產(chǎn)生孤島。在這種情況下,該算法必須用一種超微不同的形式來展現(xiàn)。因為存在數(shù)條邊界曲線而不是一個,不可能像ACOTNF中做的那樣只研究零點的一個函數(shù)。因此我們不再在算法過程中尋找零點,而是一次性的全找出來。然后建立沒有邊界的軌跡,不管這些邊界是可行域的邊緣還是孤島的邊緣。合適的軌跡可以通過搜索結(jié)果曲線圖找到一直選擇盡可能高的軌跡,有必要的話回溯。更正式的,最優(yōu)軌跡建立算法是:第一步:建立初始的加速軌跡。(與ACOTNF相同)第二步:建立最終的減速軌跡。(與ACOTNF相同)第三步:計算可行域邊線和所有的孤島邊線的函數(shù)()。在每一個零點,建立一個以零點為轉(zhuǎn)換點的軌跡,就像ACOTNF的第五步和第六步。轉(zhuǎn)換方向(加速到減速或者反過來)應(yīng)該以不使軌跡離開可行域為準來選擇。延長每條軌跡,使它或者離開可行域或者通過max.第四步:找到軌跡的所有交點。這是潛在的轉(zhuǎn)換點。第五步:從=0,=C穿過網(wǎng)格,這些網(wǎng)格是由從起始點到終點的最高的軌跡形成的。這在下面的網(wǎng)格穿越算法中有介紹。穿越有上面的第三步和第四步產(chǎn)生的軌跡形成的網(wǎng)格是對曲線圖的一個搜索,目的是要找到最終的減速軌跡。如果設(shè)想一個人沿著這些軌跡搜索這些網(wǎng)格,那么如果這可能的話他就會一直左轉(zhuǎn)。如果一個轉(zhuǎn)向引向了死角,那么就有必要回溯,然后就向右轉(zhuǎn)了。整個過程是遞歸的,就像瀏覽樹狀圖的過程一樣。算法包含兩個過程,一個是搜索加速曲線,另一個搜索減速曲線。算法是:加速搜索:在當(dāng)前的(加速)軌跡上,找到最后一個轉(zhuǎn)換點。在這一點,當(dāng)前的軌跡到達一個減速軌跡。如果那條曲線是最終的減速軌跡,那么現(xiàn)在考慮的轉(zhuǎn)換點就是最終的最優(yōu)軌跡的一個轉(zhuǎn)換點。否則,從當(dāng)前的轉(zhuǎn)換點開始進行減速搜索。如果減速搜索成功,那么當(dāng)前的點就是最優(yōu)軌跡的一個轉(zhuǎn)換點。否則,沿當(dāng)前的加速曲線回到前一個轉(zhuǎn)換點,重復(fù)這個過程。減速搜索:在當(dāng)前的(減速)軌跡,找到第一個轉(zhuǎn)換點。從該點開始應(yīng)用加速搜索。如果成功,那么當(dāng)前的點就是一個最優(yōu)軌跡的轉(zhuǎn)換點,則前移至下一個轉(zhuǎn)換點并重復(fù)這個過程。這兩個算法一直是首先尋找速度最高的曲線,因為加速搜索總是從加速曲線的末端開始,而減速搜索總是從減速曲線的開端開始。因此算法找到(如果有可能)速度最快的軌跡,因此搜索時間最短。這個算法的最優(yōu)性和一致性的證明實質(zhì)上與ACOTNF是一樣的,這里不再重復(fù)。注意在ACOTNF的一致性證明中,在零摩擦情況下只存在一條邊界曲線的事實沒有用到;因此同樣的證明也適用于高摩擦條件下。6.討論和總結(jié)在這篇文章里,我們展示了一種獲得在提供理想的幾何軌跡和輸入扭轉(zhuǎn)約束力的條件下機械手運動最小時間控制軌跡的方法。就像前面提出的,最優(yōu)軌跡可能接觸到可行域的邊界,產(chǎn)生相當(dāng)危險的情況。但是,如果在計算中使用略微保守的扭轉(zhuǎn)約束值,那么實際的可行域就會略微大于計算可行域,留出失誤的空間。在高摩擦和低摩擦情況下的算法都已經(jīng)展示了。在這兩種情況下,算法產(chǎn)生“僅僅丟失”非可行域的軌跡,不管丟失的非可行域部分是一個孤島還是有較高的速度限制形成的域。假設(shè)機器人的輸入轉(zhuǎn)矩被約束,我們得到一個測試機器人沿給定的空間路徑運動的最小時間開環(huán)控制的算法。但是,對不同的輸入?yún)?shù)也應(yīng)該可能獲得解。因為該算法產(chǎn)生真正的最小時間解,而不是一個近似值,所以該算法的結(jié)果能夠為其他的路徑設(shè)計算法提供一個絕對的測量參考。參考文獻1 D. E. Whitney, Resolved motion rate control for manipulators and human prostheses, IEEE Trans on Man-Manchine Systems, vol. MMS-10, pp. 47-53, June 1969.2 J. Y. S Luh, M. W. Walker, and R. P. C. Paul, Resolved acceleration control of mechanical manipulators, IEEE Trans on Automatic Control, vol. AC-25, no. 3, pp. 468-474, June 1980.3 S. Dubowsky and D. T. DesForges, The application of model-referenced adaptive control to robot manipulators,ASME J DSUC, vol. 101, pp. 193-200, September 1979.4 A.J. Koivo, and T. -H. Guo, Adaptive linear controller for robotic manipulators, IEEE Trans. on Automatic Control.vol. AC-28, no. 2, pp. 162-1 70, February 1983.5 B.K. Kim, and K. G. Shin, An adaptive podel following control of robotic manipulators, to appear in IEEE Trans Aerospace and Electronic Systems.6 J.Y. S. Luh and M. W. Walker, Minimum-time aiong the path for a mechanical manipulator, Proc . of the IEEE CDC, Dec. 7-9, 1977, New Orleans, pp. 755-759.7 J.Y. S. Luh, and C. S. Lin, Optimum path planning for mechanical manipulators, .4,5,VE Jounzal 3f Dynarzic Systems, Mearurement and Control , vol. 2, pp. 330-335, June 1981.8 M.E. Kahn and B. E. Roth, The near minimum-time control of open-loop articulated kinematic chains, .ASME J . DSMC, vol. 93, no. 3, pp. 164-1 72, September 1971.9 B.K. Kim and K. G. Shin, Near-optimal control of industrial manipulators with a weighted minimum time fuel criterion, to appear in Proc. 22nd CDC: San Antonio, TX., Dec. 1983.10 C.-S. Lin, P.-R. Chang, and J. Y. S. Luh, Formulation and optimization of cubic polynomial joint trajectories for mechanical manipulators, Proc . 21 CDC, Orlando, FL., Dec. 1982.11 D. E. Kirk, Optimal control theory: an introduction , Prentice-Hall, Englewood Cliffs, New Jersey, 1971, pp, 227-238.12 R. P. C. Paul, Robot manipulators: Mathematics. programming. and control, MIT Press, Cambridge, Mass., 1981, pp. 157-1 95.13 D. Ter Haar, Elements of Hamiltonian mechanics , Secondedition, Pergamon Press, 1971, pp. 35-49. 附圖:附件2外文資料
收藏