DSP和ARM的音圈電機伺服控制系統(tǒng)設計

2.3.1 DSP主程序

DSP主程序主要完成系統(tǒng)的初始化、定時器中斷配置、啟動定時器、等待定時器中斷。系統(tǒng)初始化包括時鐘初始化、外設初始化、中斷服務程序初始化等。當定時器中斷產生時，程序轉向執(zhí)行中斷，完成位置控制算法。定時器時間即位置控制算法的調節(jié)周期，根據實時位置的采樣周期來確定。定時器時間若設置過短，頻繁的調節(jié)會造成系統(tǒng)的不穩(wěn)定;若過長，則無法達到好的調節(jié)效果，本實驗中定時器時間選擇為采樣周期的4倍。主程序流程圖如圖4所示。

2.3.2 定時器T0中斷程序

定時器T0中斷程序主要完成位置環(huán)的計算。根據課題中音圈電機系統(tǒng)的特點，位置環(huán)采用積分分離式比例和積分(PI)控制算法，為減小累計誤差對系統(tǒng)的影響，采用增量式PI控制。

位置調節(jié)器的輸出可表示為：

△Pn=Pn-Pn-1=KP(en-en-1)+βKIen

其中KP、KI分別為位置調節(jié)器的比例、積分系數;en為第n次采樣的偏差;

為積分項的開關系數，ε為根據實際情況設定的積分分離閾值。

當電機的實際位置與給定期望位置的誤差小于一定值時，再恢復積分校正環(huán)節(jié)，以便消除系統(tǒng)的穩(wěn)態(tài)誤差，保證伺服電機位置控制的精度。

3 實驗結果

DSP+ARM雙核控制器硬件電路經過測試可用，并在控制器上實現了相關控制算法，驗證了算法的可行性，系統(tǒng)響應速度快，穩(wěn)態(tài)精度高。據統(tǒng)計，穩(wěn)態(tài)精度能達到30 s。圖5為階躍響應實驗曲線。圖6表明，系統(tǒng)受到外界干擾后能迅速恢復到原平衡位置，抗干擾能力強。

結語

本文提出了一種基于浮點DSP和ARM的音圈電機驅動控制器，完成了用于激光定位和掃描的音圈電機位置伺服控制。實驗結果表明，系統(tǒng)具有較好的穩(wěn)、動態(tài)性能以及抗干擾能力，可以滿足系統(tǒng)的要求。通過功能的合理劃分，實現了資源的合理配置;ARM的運用，大大簡化了硬件設計，分擔了DSP的計算任務，保證了控制系統(tǒng)的實時性。