- 相關(guān)推薦
基于DSP的仿生機器蟹多關(guān)節控制系統的實(shí)現
摘要：針對微小型步行機器人對控制系統的性能要求，介紹了一種可用于步行機器人多關(guān)節驅動(dòng)的控制系統的設計。該系統以仿生機器蟹為設計對象，采用ＤＳＰ作為核心控制器。提出了多層多目標分布式遞階控制系統的設計方案，并介紹了仿生機器蟹單步行足的軟、硬件設計方法。仿生機器蟹控制系統需要較高的控制精度和運算速度，以便在機械結構剛度較高的情況下，通過(guò)提高響應速度來(lái)確保機器人的正常行走和姿態(tài)控制。由于在機器蟹腿節和脛節置有兩個(gè)電機（如圖１所示），使其質(zhì)量較大，同時(shí)由于體積的限制使得各步行足相互間距較小，因此將造成機器蟹在行走過(guò)程中耦合較強，控制模型受軀體位姿、步行足位形和步態(tài)等因素的影響較大。這就要求控制系統控制結構靈活，具有調整步行足軌跡和步態(tài)的能力，并能適應控制模型的變化。因此必須研制一種具有強大運算處理能力、軟硬件結構模塊化的機器蟹控制系統。
從作業(yè)任務(wù)來(lái)看，兩棲仿生機器蟹的主要設計目的是用于未來(lái)的兩棲軍事偵察，因此要求其具有自主性、智能化的特點(diǎn)，并應從實(shí)用性角度出發(fā)來(lái)設計嵌入式的控制構架。
控制系統的設計目標為：
（１）對各個(gè)關(guān)節實(shí)施快速準確的位置控制；
（２）協(xié)調步行足各關(guān)節之間的運動(dòng)以及各步行足的運動(dòng)，以實(shí)現預期的目標軌跡；
（３）實(shí)時(shí)地采集、處理傳感器的數據，以便在控制系統的信號綜合中使用；
（４）實(shí)現機器人步態(tài)規劃、運動(dòng)方程的求解以及控制指令的快速傳輸；
（５）具有良好的控制結構和接口，便于高層控制軟件的開(kāi)發(fā)；
（６）有一定的預留接口、良好的兼容性和擴展性，以便進(jìn)行功能擴展和二次開(kāi)發(fā)與研究；
（７）具有模塊化結構，以便調整步行足的數量，適用于不同步態(tài)形式的控制。
１ 多層多目標分布式控制概念及控制框架
仿生機器蟹是一個(gè)復雜的控制對象，從體系上講，其每條步行足都是一個(gè)多自由度的串聯(lián)臂機器人。要實(shí)現有效的控制，除要對每條步行足的三個(gè)驅動(dòng)關(guān)節進(jìn)行準確高效的控制外，多條步行足之間還要相互協(xié)調，共同完成某一確定工作。同時(shí)應考慮到各條步行足運動(dòng)空間之間的相互重迭、相互干擾所形成的強耦合。常用的控制方法有分散控制、分布式控制和遞階控制三種形式。由于遞階控制系統具有控制結構清晰、層次分明的特點(diǎn)，而分布式控制系統便于采用模塊化結構且可擴展性好，因此機器蟹控制系統采用遞階控制和分布式控制相結合的控制結構設計。由于其控制結構較復雜，所以將整個(gè)控制體系分為任務(wù)規劃、任務(wù)分解、軀體路徑規劃、運動(dòng)協(xié)調、步行足軌跡規劃、運動(dòng)學(xué)／動(dòng)力學(xué)計算、電機伺服控制等多層結構，而且每層之間要通過(guò)上層進(jìn)行運動(dòng)協(xié)調，例如各個(gè)步行足之間的運動(dòng)控制協(xié)調，需要步行足控制層通過(guò)步行運動(dòng)協(xié)調層交換信息。每條步行足的指關(guān)節之間的控制也是如此。因此，機器蟹控制系統采用多層多目標分布式遞階控制系統，如圖２所示。
第一層稱(chēng)為“動(dòng)機層”，它使得機器人本體能夠做到完全的自主。其目的是將由外部環(huán)境變化或操作者命令引起的本體內部的響應翻譯成對機器人本體的高級命令。
第二層是“軀體路徑層”，它接收“動(dòng)機層”給出的高級命令，將其轉化為一系列的本體內部的描述量及認知圖，進(jìn)而給出機器人自身軀體的運動(dòng)路徑。
第三層稱(chēng)為“步行足軌跡層”，它針對軀體的運動(dòng)路徑給出各個(gè)足的具體的運動(dòng)，包括步態(tài)的生成和腿的路徑的生成。
第四層是“動(dòng)力實(shí)現層”，它通過(guò)驅動(dòng)組件實(shí)現由“步行足軌跡層”給出的足的運動(dòng)，并對由于系統的動(dòng)力學(xué)不確定性和干擾造成的誤差進(jìn)行校正。
各層之間，上層向下層輸出控制量，由下層來(lái)具體實(shí)施。每執行一步，下層將狀態(tài)信息實(shí)時(shí)地反饋給上層。
２ 單步行足控制系統的硬件設計
按照上述設計方案，采用自下而上的設計思路進(jìn)行機器蟹控制系統的開(kāi)發(fā)，以保證系統開(kāi)發(fā)的可靠性，同時(shí)也符合模塊化設計思想：在總體確定后，進(jìn)行各功能模塊的設計，并通過(guò)設計模塊間的接口來(lái)組合成完整的系統。
首先使用ＴＭＳ３２０ＬＦ２４０７開(kāi)發(fā)步行足伺服控制器模塊，這是為了配合機器蟹樣機本體的研制開(kāi)發(fā)而同步進(jìn)行的，這樣有利于控制系統與被控對象間的兼容。
步行足伺服模塊包括ＤＳＰ的最小系統、ＲＳ２３２通訊接口、ＤＰＲＡＭ接口、ＰＷＭ輸出、電機碼盤(pán)ＱＥＰ信號檢測、碼盤(pán)計數、關(guān)節轉角初始定位、力信號檢測等部分，如圖３所示。伺服控制模塊的各外設接口功能如下：
（１）ＲＳ２３２通訊接口：實(shí)現ＰＣ機與ＬＦ２４０７的上下層通訊，以便在單步行足控制實(shí)驗中進(jìn)行控制和狀態(tài)觀(guān)察；
（２）ＤＰＲＡＭ接口：用于實(shí)際機器蟹控制系統的多控制模塊級聯(lián)通訊和伺服模塊與ＴＭＳ３２０ＶＣ５４１０系統的通訊；
（３）ＰＷＭ輸出接口：利用ＴＭＳ３２０ＬＦ２４０７的片內外設生成數字ＰＷＭ信號，作為電機控制信號；
（４）碼盤(pán)計數接口：用于電機轉速檢測中的正交編碼信號（ＱＥＰ）檢測、電機旋轉方向判斷，與關(guān)節轉角定位信號結合使用，來(lái)檢測關(guān)節轉角；
（５）關(guān)節轉角初始定位接口：采集用于關(guān)節初始定位的霍爾傳感器信號；
（６）力信號接口：處理和檢測足端ＦＳＲ傳感器的接觸力信號。
圖4 計數器結構框圖
２．１ ＴＭＳ３２０ＬＦ２４０７的功能介紹
【基于DSP的仿生機器蟹多關(guān)節控制系統的實(shí)現】相關(guān)文章：
DNP3.0在基于DSP的FTU中的實(shí)現03-18
基于DSP的擴頻電臺基帶模塊的設計與實(shí)現03-18
基于幀的實(shí)時(shí)話(huà)音變換技術(shù)與DSP實(shí)現03-07
基于DSP的視頻檢測和遠程控制系統設計03-20
基于A(yíng)DI TigerSHARC DSP的OFDM收發(fā)信機的設計與實(shí)現03-30
基于USB與DSP的指紋識別系統的設計實(shí)現03-19
基于DSP感應電機變頻調速控制系統設計03-07