基于1553B總線的航天大功率電動(dòng)舵機(jī)控制器設(shè)計(jì)

3.1 DSP主程序設(shè)計(jì)

DSP主要實(shí)現(xiàn)了控制系統(tǒng)主程序和電流、位置、速度三閉環(huán)數(shù)字PID控制算法。FPGA將接收到的舵面偏轉(zhuǎn)信號(hào)和采集到的轉(zhuǎn)子位置、轉(zhuǎn)速和實(shí)際舵面偏角傳遞給DSP，DSP結(jié)合自身ADC采樣電流信號(hào)，通過算法處理，輸出調(diào)制PWM。程序流程如圖5所示。

圖5DSP主程序流程 3.2 FPGA邏輯程序設(shè)計(jì)

FPGA程序采用模塊化設(shè)計(jì)思想，實(shí)現(xiàn)了BU-61580讀寫RAM控制時(shí)序、FB9412PB控制時(shí)序、SSI208P控制時(shí)序和DSP接口控制邏輯。各個(gè)模塊的時(shí)序控制如圖6-11所示。

4 結(jié)論

本文設(shè)計(jì)實(shí)現(xiàn)了一套基于1553B總線通訊的大功率無刷直流電動(dòng)舵機(jī)控制器，利用DSP高速運(yùn)算性能實(shí)現(xiàn)電流、速度、位置三閉環(huán)控制算法，充分運(yùn)用FPGA靈活可配置性設(shè)計(jì)時(shí)序邏輯控制電路，采用BU-61580協(xié)議芯片實(shí)現(xiàn)1553BRT終端控制器。實(shí)際應(yīng)用表明，該控制器控制精度高、調(diào)節(jié)速度快，具有良好的工程應(yīng)用價(jià)值。