擬人機器人上肢多關節(jié)控制參數(shù)整定

摘要：為了得到擬人機器人上肢關節(jié)控制電機的精確參數(shù)，通過建立直流電機的物理和數(shù)學模型，利用Matlab軟件建模和仿真，找到了一個合適的PID控制方法，通過調(diào)節(jié)KP，KI，KD參數(shù)，系統(tǒng)獲得了較高的控制精度和響應速度，幾乎能夠完全抵抗外部干擾，該仿真對擬人機器人手部控制節(jié)點的設計具有很重要的指導作用，對于一般的直流電機閉環(huán)控制也有一定的借鑒意義。

關鍵詞：擬人機器人；PID控制；直流電機建模；Matlab

0 引言

擬人機器人手部控制節(jié)點的任務是接收機器人“大腦”(即上位機)的指令，完成手部電機的速度及位置控制。擬人機器人手部電機采用DC電機，通常DC電機抗干擾能力有限。本文探索DC電機的PID閉環(huán)控制手段，為了得到較好的可能效果，需要尋找合適的控制參數(shù)：KP，KI，KD。文中首先對DC電機進行物理抽象，進而建立數(shù)學模型，并通過實驗手段得到實際電機的系統(tǒng)參數(shù)。最后通過模擬手段，實現(xiàn)擬人機器人手部電機開環(huán)控制系統(tǒng)及速度閉環(huán)PID控制系統(tǒng)的仿真，并通過調(diào)節(jié)KP，KI，KD獲得較好的抗干擾相應。通過仿真得到的控制參數(shù)可以反過來用于指導控制節(jié)點的設計。

1 DC電機建模

1．1 建立直流電機的物理模型

電機的物理模型如圖1所示。

1．2 DC電機數(shù)學模型的建立

式(1)是理論分析得到的電機開環(huán)控制的數(shù)學模型。判斷一個模型是否適用于實際的擬人機器人手部DC電機，需要將實際測量電機的相應曲線和理論公式進行比較。

1．3 實際電機的開環(huán)階躍響應

為了確定上述電機模型的參數(shù)，同時驗證上述電機模型的正確性，首先對電機進行開環(huán)階躍響應實驗，給定電機一個目標速度設定，測出電機速度隨時間的變化曲線。擬人機器人手部電機裝有16線編碼盤，給電機加上128／256的PWM站空比(相當于2．5 V電壓，PWM站空比與e1成線性關系)，利用單片機的寄存器，通過編寫一定的程序測得一組電機每轉(zhuǎn)過π／8對應的時間值，為了處理實際測量得到的數(shù)據(jù)，使用VC編寫一個數(shù)據(jù)處理程序，在Matlab中運行由VC程序自動生成的．m文件，就可以繪出擬人機器人手部DC電機的響應曲線。在Matlab中運行該文件就可以得到電機的響應曲線，如圖2所示。