哈爾濱工程大學學報艦載特種起重機軌跡跟蹤吊重防擺控制曾昭龍,田凱,李文秀(哈爾濱工程大學自動化學院,黑龍江哈爾濱150001)亞譜諾夫后推法的基本原理,提出了一種基于李亞譜諾夫后推法的軌跡跟蹤吊重防擺控制算法。該方法基于反饋控制原理,利用起重機關節(jié)間的耦合作用,將吊重擺角和關節(jié)運動變量作為反饋量進行控制器的綜合設計,以實現(xiàn)減小吊重擺角??刂葡到y(tǒng)仿真結果表明該控制方法在控制起重機機械臂各關節(jié)平穩(wěn)的跟蹤給定軌跡的同時,能夠實現(xiàn)吊重在三維空間的防擺控制。
―)男,博士研究生;李文秀(1940―)男,教授,博士生導師。
艦載特種起重機結構示意圖如所示。
它是由4段形狀比較規(guī)則的剛性桿件通過關節(jié)連接形成的一種與多關節(jié)剛性機械臂結構類似的起艦載特種起重機是我國正在研制開發(fā)的艦上某型垂直熱發(fā)射超低空近距離作戰(zhàn)導彈裝填機構111.它是一種新型的多關節(jié)、可伸縮折疊式船用起重機,平時折疊存放于甲板下的艙室中,工作時被舉升至甲板面鎖定后開始工作。艦載特種起重機是緊固在艦船上的導彈自動裝填機構,在作業(yè)過程中無法避免由于海浪的運動對其造成的不利影響,即在海浪的作用下,載艦將會產(chǎn)生橫搖運動(暫只考慮橫搖運動)同時由于吊重與起重機機械臂末端通過鋼纜柔性連接,因此載艦的這種運動是通過不斷改變位置和姿態(tài)的起重機機械臂各關節(jié)傳遞到機械臂末端并與各關節(jié)的運動相疊加作用在與機械臂末端柔性連接的鋼纜上,繼而會使吊重不可避免的隨載艦以及起重機機械臂各關節(jié)的運動而發(fā)生擺動。吊重的這種三維空間的擺動,對起重機的平穩(wěn)運行以及安全作業(yè)有著嚴重的影響。因此,進行軌跡跟蹤控制的同時,對該系統(tǒng)進行吊重防擺控制研究有著重要意義2―31.1系統(tǒng)結構特點和動力學模型重機系統(tǒng)。載艦以及關節(jié)的運動會引起吊重的擺動,而各關節(jié)是由相應的液壓裝置驅動的,因此,整個艦載特種起重機系統(tǒng)就是一個由液壓驅動系統(tǒng)、起重機機械臂系統(tǒng)和鋼纜吊重系統(tǒng)構成的串聯(lián)系統(tǒng),其系統(tǒng)結構如所示。
艦載特種起重機串連系統(tǒng)示意圖由可以更加直觀的看出艦載特種起重機系統(tǒng)的這一串級特點,后級子系統(tǒng)由前級系統(tǒng)來驅動,*終由實際控制輸入完成系統(tǒng)的控制。因此,從結構上看,該系統(tǒng)能夠應用李亞普諾夫后推法進行控制器的設計14一51.利用拉格朗日法建立載艦橫搖條件下起重機機械臂動力學模型如中+9(q>,qV,?。?0.:知T12.2起重機機械臂系統(tǒng)引入輔助控制量u2,由起重機機械臂系統(tǒng)逆運動學得負載壓力期望值為力學模型如式(2):并令液壓系統(tǒng)實際負載壓力與期望負載壓力的偏差Z=p―Pd,則式(1)中起重機機械臂子系統(tǒng)可以表示如下:。成立He2.3液壓驅動系統(tǒng)對式(2)中的液壓驅動系統(tǒng)進行補償,令壓驅動系統(tǒng)補償控制量。則由前面和Z的定義,液壓驅動系統(tǒng)可以表示為v:Z=P-Pd因此基于上述3個串聯(lián)子系統(tǒng)模型的李亞普諾夫后推法軌跡跟蹤防擺控制器設計的主要任務就是通過選擇適當?shù)妮o助控制量Ui,U2和U3滿足¢1和¢2收斂到零。
3軌跡跟蹤吊重防擺控制器定理對于由子系統(tǒng)M、和L組成的艦載特種起重機串聯(lián)系統(tǒng),在吊重系統(tǒng)反饋控制器FC1:的作用下能夠使得¢1和¢2漸進收斂到零。其中,利用李亞譜諾夫后推法對各子系統(tǒng)進行鎮(zhèn)定,可以得到相應的輔助控制輸入U1、U2和U3.為李亞普諾夫函數(shù),則其對時間t的導數(shù)為:貝I其對時間的導數(shù):必須有6(1,即可令將式(11)代入式(10)中,貝有考察由子系統(tǒng)式(4)和(5)組成的系統(tǒng),并設U1由式(11)確定。取正定函數(shù):同樣,有由機器人物理性質:5T.(12)此時令即通過選擇U2可使子系統(tǒng)L和。
在空間的*大旋轉半徑為成的系統(tǒng)滿足李亞譜諾夫穩(wěn)定性。
考慮由子系統(tǒng)式(4)、(5)和(6)組成的整個系統(tǒng),并設U2由式(13)給定。取正定函數(shù):所以,有將式(15)代入式(14)中,因L是正定的,則有3(ei,51,專2,ZtX0成立。即通過選擇M3可使子系統(tǒng)L、和組成的系統(tǒng)滿足李亞普諾夫穩(wěn)定性。
由以上的推導過程,可以得到吊重系統(tǒng)反饋控制器FCi和起重機機械臂系統(tǒng)反饋控制器FC2如式(7)和式(8)所示。起重機系統(tǒng)在FCi和FC2的作用下能夠滿足控制需要,即實現(xiàn)起重機各關節(jié)軌跡跟蹤的同時,又實現(xiàn)了吊重的防擺控制。
4系統(tǒng)仿真分析4.1仿真條件軌跡規(guī)劃采用所示的結果;載艦橫搖運動選擇正弦運動規(guī)律:qs(=即載艦*大橫搖角為10°周期為8s;4.2仿真結果分析在上述仿真條件下得到起重機將吊重從起吊點上方搬運到某指定位置上方過程中,各關節(jié)軌跡跟蹤曲線和吊重擺動曲線如、所示。
從可以看出,該控制系統(tǒng)能夠較好的實現(xiàn)軌跡跟蹤控制目標。其中軌跡跟蹤的誤差以回轉關節(jié)*大,*大時達到了76%,但是*后還是逐漸逼近了給定曲線,各條軌跡跟蹤誤差均小于±2%.從可以看出在該軌跡跟蹤吊重防擺控制器的作用下,能夠將吊重在豎直方向的擺動控制在很小的范圍內,而且擺動不是很劇烈;另外,控制過程中吊重⑻吊重豎直擺角吊重在豎直和水平方向的擺角5結束語文中提出的起重機軌跡跟蹤吊重防擺控制方法,基于反饋控制原理,利用起重機關節(jié)間的耦合作用,將吊重擺角和關節(jié)運動變量作為反饋量進行控制器的綜合設計,達到實現(xiàn)減小擺角的目的。系統(tǒng)仿真結果表明該方法在完成各關節(jié)軌跡跟蹤控制的同時,對吊重的擺動有明顯的抑制作用。
需要指出的是起重機軌跡跟蹤和吊重防擺是相互制約的,兩者是一對矛盾體。控制系統(tǒng)中的某些設計參數(shù)需要在仿真過程中進行試湊,用以權衡軌跡跟蹤和吊重防擺的精度。