1 APT控制系統(tǒng)組成
APT控制系統(tǒng)由PWM脈沖控制和產(chǎn)生模塊、RS 232串行通信接口模塊、光電編碼接口模塊及人機交互模塊組成,系統(tǒng)框圖如圖1所示。
核心控制芯片選用Philips公司生產(chǎn)的專用工業(yè)控制ARM芯片LPC2124。先由串口接收到由信標光圖像處理部分得到的光斑坐標值,通過位置跟蹤算法計算出輸出,PWM的控制量值,再由PWM產(chǎn)生模塊送出PWM脈沖到電機驅(qū)動器驅(qū)動電機,最終帶動轉(zhuǎn)臺指向目標位置。光電編碼器反饋回電機的速度信息到處理器,運用相應(yīng)的控制算法可以將轉(zhuǎn)臺的運行速度穩(wěn)定在設(shè)定值,防止電機因速度不穩(wěn)定而擾動。在控制過程中,轉(zhuǎn)臺的運行狀態(tài)、速度和位置等信息皆可由LCD顯示,轉(zhuǎn)臺的運行速度、掃描步長等由鍵盤輸入設(shè)定。
2 硬件設(shè)計
2.1 LPC2124處理器簡介
LPC2124是基于一個支持實時仿真和跟蹤的32位ARM7TDMI-S CPU,是世界首款可加密的ARM芯片,并帶有256 KWord嵌入的高速FLASH存儲器和16 KB的SRAM,完全能滿足系統(tǒng)存儲空間的要求,故不需要外加存儲擴展,使系統(tǒng)更為簡單、可靠。內(nèi)部具有UART,硬件I2C,SPI,PWM,ADC,定時器和比較捕獲單元等眾多應(yīng)用部件,功能十分強大,遠遠能滿足APT控制系統(tǒng)的功能設(shè)計要求。3.3 V和1.8 V供電電壓可使系統(tǒng)保持低功耗,128位寬度的存儲器接口和獨特的加速結(jié)構(gòu)可使32位代碼在最大時鐘速率下運行,提高了代碼運行速度,獨特的16位Thumb模式可使代碼規(guī)模的降低超過30%,而系統(tǒng)的性能損失卻很小,提高了代碼的運行效率,大大降低了程序的優(yōu)化難度。特別適用于工業(yè)控制、醫(yī)療系統(tǒng)和訪問控制系統(tǒng)。
2.2 電源電路
LPC2124的內(nèi)核及片內(nèi)外設(shè)供電電壓為1.8 V,I/O口所需電壓為3.3 V,而整個數(shù)字電路的供電電源為5 V,且通過78M05將電源5 V穩(wěn)壓,故選用了LDO芯片LM1117MPX-3.3和LM1117MPX-1.8穩(wěn)壓輸出3.3 V及1.8 V電壓,其電路如圖2所示。
2.3 RS 232接口模塊
通過串口獲取光斑的坐標值,由于系統(tǒng)芯片是3.3 V系統(tǒng),所以使用MAX 3232進行RS 232電平轉(zhuǎn)換,其電路原理圖如圖3所示。
關(guān)鍵字:ARM 空問光通信 APT控制
通過設(shè)置LPC2124控制寄存器U0LCR,UODLM和U0DLL來設(shè)置工作模式及波特率。
2.4 JTAG接口電路設(shè)計
采用ARM公司提出的標準20腳JTAG作為仿真調(diào)試接口,JTAG信號的定義及與LPC2124的連接如圖4所示。圖中,JTAG接口上的信號nRST,nTRST與整個系統(tǒng)的復(fù)位電路連接,以達到與控制系統(tǒng)共同復(fù)位的目的。
2.5 電機控制及驅(qū)動設(shè)計
通過設(shè)置LPC2124的PWMMR0,PWMMR6寄存器來設(shè)置輸出PWM的周期及占空比,從而控制轉(zhuǎn)臺的運行速度。電機驅(qū)動采用DMD402型二相步進電機驅(qū)動器,該驅(qū)動器可提供整步、半步、8-16檔細分共三種運行模式。另外,通過比較捕獲單元接收通過光電編碼器反饋產(chǎn)生的正交編碼信號,經(jīng)程序處理后得到電機的當前運行速度,再對速度進行調(diào)節(jié)。
2.6 LCD顯示器及鍵盤設(shè)計
利用點陣式液晶顯示器實現(xiàn)中文提示界面,增強了人機交互性。設(shè)計中采用128×64的點陣LCD,使用內(nèi)藏T6963C作為控制器。另外,使用4×4矩陣鍵盤作為用戶輸入。
3 軟件設(shè)計
APT控制系統(tǒng)主要由掃描、捕獲和跟蹤三部分組成,下面是這幾部分程序設(shè)計的介紹。
3.1 掃描及捕獲部分
上電復(fù)位運行后,程序先完成各部分的初始化工作,顯示歡迎界面,并提示用戶輸入轉(zhuǎn)臺運行速度及掃描步長,接著程序開始執(zhí)行光柵螺旋掃描算法。光柵螺旋掃描算法示意圖如圖5所示,圖中每個小圓代表一個信標掃描子區(qū),每個子區(qū)以正方形方式重疊。設(shè)每個子區(qū)的直徑為信標發(fā)散角α,則掃描步長為:
以步長α0在不確定區(qū)域內(nèi)搜索目標,直到捕獲到信標光斑,然后轉(zhuǎn)入跟蹤狀態(tài)。
3.2 基于增量式PID控制的跟蹤算法
PID控制算法包括位置式PID控制算法和增量式PID控制算法。在實時控制系統(tǒng)中常用增量式PID控制算法,其公式為:
式中:△u(k)為輸出的控制量;q0=KP;q1=KP(TS/TI);q2=KP(TD/TS)分別為比較項、積分項和差分項的系數(shù);TS為采樣時間,對于不同的控制系統(tǒng),TS各不相同,要根據(jù)實際調(diào)試經(jīng)驗來確定,該實驗中TS為0.15 s。由式(1)可知,只要貯存最近的三個誤差采樣值e(k),e(k-1),e(k-2)就可以計算出△u(k),從而實現(xiàn)位置和速度的反饋控制,完成穩(wěn)定跟蹤。
3.3 系統(tǒng)流程圖
由上分析,可得到系統(tǒng)流程圖如圖6所示。
4 測試結(jié)果及結(jié)論
經(jīng)實驗測試,整個系統(tǒng)最高功耗約為20 W,轉(zhuǎn)臺轉(zhuǎn)動速度范圍為0.2~0.8(°)/s,跟蹤精度按照標準差計算,最小約達20.69μrad,最快響應(yīng)時間可達200 ms。利用Philips公司生產(chǎn)的ARM芯片LPC2124作為控制核心來進行設(shè)計與開發(fā),從測試結(jié)果可以看出,系統(tǒng)功耗較低,精度基本上滿足了APT控制系統(tǒng)的要求,具有較大的實用價值。