基于單片機的快速位置伺服系統(tǒng)的設(shè)計

O 引言
本設(shè)計要求對某火炮的水平和高低角進行控制，達到快速位置伺服系統(tǒng)的要求。而這個火炮角度控制系統(tǒng)首先要求有快速性，它的反應(yīng)時間大于或等于12°／s；角度轉(zhuǎn)動控制精度小于或等于1’，水平角轉(zhuǎn)動范圍從一120°～+120°，高低角轉(zhuǎn)動范圍從0°～+85°；最后系統(tǒng)要有很好的穩(wěn)定性和動態(tài)性能。
由于位置伺服系統(tǒng)一般是以足夠的位置控制精度、位置跟蹤精度和足夠快的跟蹤速度作為它的主要控制目標，系統(tǒng)運行時要求能以一定的精度隨時跟蹤指令的變化。所以對于這種快速位置伺服系統(tǒng)，要求整個系統(tǒng)各部分配合良好，其中的關(guān)鍵是控制器的選擇，綜合考慮高精度、抗干擾能力、靈活性、可靠性、實時性、性價比等各因素的情況下。選擇了Frees—cale公司的MC9Sl2DGl28B作為控制器。MC9Sl2DGl28B芯片是一款16位的單片機，功能強大，性能優(yōu)越。本文采用該型號的單片機保證了所設(shè)計系統(tǒng)的穩(wěn)定可靠。

1 系統(tǒng)控制方案
由于設(shè)計的角度伺服系統(tǒng)的負載比較大，而且相對于工業(yè)控制要求而言系統(tǒng)精度和快速性要求高，所以整個系統(tǒng)采用混合閉環(huán)的控制結(jié)構(gòu)，所謂混合閉環(huán)的控制結(jié)構(gòu)，就是系統(tǒng)內(nèi)同時存在半閉環(huán)和閉環(huán)。半閉環(huán)起到控制作用，而全閉環(huán)只用于穩(wěn)態(tài)誤差補償，兩者相結(jié)合可獲得較高的位置控制精度和跟蹤速度。包括：MJX40—14型光電編碼器、90LCX一3直流伺服電機、12A8型PWM直流伺服電機驅(qū)動器、單片機控制系統(tǒng)。單片機控制系統(tǒng)由MC9Sl2DGl28B單片機實現(xiàn)，使用Code Warrior for HCl2 V4．6編譯器，采用C語言編程。由于水平角和高低角的控制是一樣的，而且共用一個單片機，以角度控制方框圖(圖1)來說明。

如圖1所示，系統(tǒng)的任務(wù)是使光電編碼器測得的炮架轉(zhuǎn)動角度θ2與給出的指令θ1相等。當(dāng)θ1≠θ2時，θ1一θ2的偏差信號在單片機里進行處理，放大后輸入到PWM直流伺服電機驅(qū)動器，由PWM驅(qū)動器驅(qū)動直流伺服電機，伺服電機帶動減速器，驅(qū)動炮架向著減少偏差的方向移動，直到θ1=θ2，電機停止轉(zhuǎn)動，達到目標。同時，炮架要準確的跟蹤目標，必須減少在跟蹤過程中可能出現(xiàn)的速度變化(如風(fēng)速等原因)，因為直流伺服電機本身帶有測速機端，可以把速度反饋信號進行負反饋輸入到PWM伺服電機驅(qū)動器，這樣使轉(zhuǎn)動機械的轉(zhuǎn)速度變化很小，起著穩(wěn)速的作用。

2 硬件系統(tǒng)設(shè)計
2．1 總體設(shè)計
整個硬件系統(tǒng)采用模塊化思想設(shè)計，硬件系統(tǒng)框圖如圖2所示，分為單片機CPU最小系統(tǒng)、鍵盤／顯示控制模塊、直流伺服電機驅(qū)動電路、系統(tǒng)輸入模塊、光電編碼器等。設(shè)計時，各個模塊可相對獨立設(shè)計調(diào)試，最后集成為整個系統(tǒng)。

2．2 模塊結(jié)構(gòu)和功能簡要說明
CPU最小系統(tǒng)：系統(tǒng)的主控模塊，用以控制和協(xié)調(diào)其它模塊工作。
鍵盤／顯示控制：由鍵盤及LED管理芯片CH451控制。系統(tǒng)輸入模塊：用通用8155芯片做數(shù)據(jù)采集，獲取光電編碼器所測得的火炮當(dāng)前角度(位置)值，并傳給主控芯片。伺服電機驅(qū)動電路：用帶有緩沖基準輸入的雙路12位電壓輸出數(shù)字一模擬轉(zhuǎn)換器(TLC5618)作為單片機的一個外圍的D／A接口；當(dāng)系統(tǒng)把偏差值算好后，利用PID算法得出的數(shù)據(jù)量輸出到兩路TLC5618，再通過驅(qū)動器去驅(qū)動水平和高低角的伺服電機，精確控制火炮的高低角和水平角位置和速度。
SCI通信：通過串行通信模塊。系統(tǒng)可以與上位機連接，方便對系統(tǒng)軟件的更新和升級，且可通過上位機進行控制角度控制，監(jiān)視單片機的輸入與輸出。光電編碼器：用于得到炮架的轉(zhuǎn)動角度。
2．3 主要模塊設(shè)計