《基于DSP的仿生機器蟹多關(guān)節(jié)控制系統(tǒng)的實現(xiàn)》由會員分享,可在線閱讀,更多相關(guān)《基于DSP的仿生機器蟹多關(guān)節(jié)控制系統(tǒng)的實現(xiàn)(2頁珍藏版)》請在裝配圖網(wǎng)上搜索。
1、
基于DSP的仿生機器蟹多關(guān)節(jié)控制系統(tǒng)的實現(xiàn)
摘要:針對微小型步行機器人對控制系統(tǒng)的性能要求,介紹了一種可用于步行機器人多關(guān)節(jié)驅(qū)動的控制系統(tǒng)的設(shè)計。該系統(tǒng)以仿生機器蟹為設(shè)計對象,采用DSP作為核心控制器。提出了多層多目標分布式遞階控制系統(tǒng)的設(shè)計方案,并介紹了仿生機器蟹單步行足的軟、硬件設(shè)計方法。 仿生機器蟹控制系統(tǒng)需要較高的控制精度和運算速度,以便在機械結(jié)構(gòu)剛度較高的情況下,通過提高響應(yīng)速度來確保機器人的正常行走和姿態(tài)控制。由于在機器蟹腿節(jié)和脛節(jié)置有兩個電機(如圖1所示),使其質(zhì)量較大,同時由于體積的限制使得各步行足相互間距較小,因此將造成機器
2、蟹在行走過程中耦合較強,控制模型受軀體位姿、步行足位形和步態(tài)等因素的影響較大。這就要求控制系統(tǒng)控制結(jié)構(gòu)靈活,具有調(diào)整步行足軌跡和步態(tài)的能力,并能適應(yīng)控制模型的變化。因此必須研制一種具有強大運算處理能力、軟硬件結(jié)構(gòu)模塊化的機器蟹控制系統(tǒng)。
從作業(yè)任務(wù)來看,兩棲仿生機器蟹的主要設(shè)計目的是用于未來的兩棲軍事偵察,因此要求其具有自主性、智能化的特點,并應(yīng)從實用性角度出發(fā)來設(shè)計嵌入式的控制構(gòu)架。
控制系統(tǒng)的設(shè)計目標為:
(1)對各個關(guān)節(jié)實施快速準確的位置控制;
(2)協(xié)調(diào)步行足各關(guān)節(jié)之間的運動以及各步行足的運動,以實現(xiàn)預(yù)期的目標軌跡;
(3)實時地采集、處理傳感器的數(shù)據(jù),以便在控制系統(tǒng)的
3、信號綜合中使用;
(4)實現(xiàn)機器人步態(tài)規(guī)劃、運動方程的求解以及控制指令的快速傳輸;
(5)具有良好的控制結(jié)構(gòu)和接口,便于高層控制軟件的開發(fā);
(6)有一定的預(yù)留接口、良好的兼容性和擴展性,以便進行功能擴展和二次開發(fā)與研究;
(7)具有模塊化結(jié)構(gòu),以便調(diào)整步行足的數(shù)量,適用于不同步態(tài)形式的控制。
1 多層多目標分布式控制概念及控制框架
仿生機器蟹是一個復(fù)雜的控制對象,從體系上講,其每條步行足都是一個多自由度的串聯(lián)臂機器人。要實現(xiàn)有效的控制,除要對每條步行足的三個驅(qū)動關(guān)節(jié)進行準確高效的控制外,多條步行足之間還要相互協(xié)調(diào),共同完成某一確定工作。同時應(yīng)考慮到各條步行足運動空間之間的相互
4、重迭、相互干擾所形成的強耦合。常用的控制方法有分散控制、分布式控制和遞階控制三種形式。由于遞階控制系統(tǒng)具有控制結(jié)構(gòu)清晰、層次分明的特點,而分布式控制系統(tǒng)便于采用模塊化結(jié)構(gòu)且可擴展性好,因此機器蟹控制系統(tǒng)采用遞階控制和分布式控制相結(jié)合的控制結(jié)構(gòu)設(shè)計。由于其控制結(jié)構(gòu)較復(fù)雜,所以將整個控制體系分為任務(wù)規(guī)劃、任務(wù)分解、軀體路徑規(guī)劃、運動協(xié)調(diào)、步行足軌跡規(guī)劃、運動學(xué)/動力學(xué)計算、電機伺服控制等多層結(jié)構(gòu),而且每層之間要通過上層進行運動協(xié)調(diào),例如各個步行足之間的運動控制協(xié)調(diào),需要步行足控制層通過步行運動協(xié)調(diào)層交換信息。每條步行足的指關(guān)節(jié)之間的控制也是如此。因此,機器蟹控制系統(tǒng)采用多層多目標分布式遞階控制系統(tǒng),如圖2所示。
第一層稱為“動機層”,它使得機器人本體能夠做到完全的自主。其目的是將由外部環(huán)境變化或操作者命令引起的本體內(nèi)部的響應(yīng)翻譯成對機器人本體的高級命令。
第二層是“軀體路徑層”,它接收“動機層”給出的高級命令,將其轉(zhuǎn)化為一系列的本體內(nèi)部的描述量及認知圖,進而給出機器人自身軀體的運動路徑。
第三層稱為“步行足軌跡層”,它針對軀體的運動路徑給出各個足的具體的運動,包括步態(tài)的生成和腿的路徑的生成。