基于DSP的雙足機器人運動控制系統(tǒng)設計

主控計算機根據(jù)步態(tài)規(guī)劃的數(shù)據(jù)，發(fā)出運動指令，生成下一個運動周期各個電機的轉動方向和角度等控制參數(shù)，運動控制器接收到新的數(shù)據(jù)之后，PWM控制根據(jù)數(shù)據(jù)計算出占空比信息并生成相應的PWM波，進而控制電機轉動，隨后將電機光電編碼器傳送回的信號轉換成關節(jié)位置和速度等信息，補償控制針對速度和位置誤差采用PID算法進行調節(jié)，計算需要的執(zhí)行量，調整PWM波形，在每一個運動周期內使電機達到指定的速度，并使運動中的關節(jié)電機能夠克服機器人重力和外力的影響，保持在設定的角度。圖5是CCS仿真調試時，程序運行后在指定的擺動角度下監(jiān)控到的單關節(jié)電機速度跟蹤曲線，其響應時間和穩(wěn)定性基本滿足雙足步行的要求。

5 結語
介紹了一種基于DSP的無刷直流電機運動控制系統(tǒng)，在控制方案的具體實現(xiàn)過程中，根據(jù)機器人腿部系統(tǒng)的自身特點，將控制器圍繞DSP處理和電機控制電路來分別設計，這樣既方便設計和調試，又增強了系統(tǒng)的靈活性和擴展性。電機驅動采用速度和位置雙閉環(huán)控制，保證運轉精度。經(jīng)測試，系統(tǒng)基本滿足運動控制的要求，為雙足步行規(guī)劃提供了試驗平臺。