基于雙單片機的懸掛物體尋跡控制系統(tǒng)

2 系統(tǒng)方案設(shè)計

    懸掛物體運動控制系統(tǒng)的基本方案方框圖如圖3所示，系統(tǒng)主要由控制模塊、黑線檢測模塊和通信模塊組成。其中，控制模塊由ATmega128L單片機最小系統(tǒng)1、鍵盤輸入電路、液晶顯示電路和步進電機驅(qū)動電路組成；檢測模塊由ATmega128L單片機最小系統(tǒng)2、紅外線反射電路和微步進電機驅(qū)動電路組成。

    黑線檢測模塊中的單片機系統(tǒng)控制微型步進電機，帶動裝有紅外探頭的搖臂巡回擺動，檢測板上的黑線，得出微型步進電機的轉(zhuǎn)動角度。角度數(shù)據(jù)經(jīng)過編碼后，通過無線傳輸模塊發(fā)送給控制模塊單片機系統(tǒng)?？刂颇K中的單片機系統(tǒng)接收到角度數(shù)據(jù)后．進行數(shù)據(jù)校驗。若數(shù)據(jù)準確，則通過控制步進電機驅(qū)動電路控制懸掛物體從當前坐標沿轉(zhuǎn)動角度移動固定距離，然后，向檢測模塊發(fā)出下一輪檢測命令；若數(shù)據(jù)傳輸有誤，則向檢測模塊發(fā)出數(shù)據(jù)重發(fā)命令，等待下一輪角度數(shù)據(jù)接收。

3．1 ATmega128L單片機最小系統(tǒng)

    單片機是整個懸掛物體運動控制系統(tǒng)的核心，控制系統(tǒng)所有電路。本系統(tǒng)采用Atmel公司的ATmega128L單片機，有如下特點：

    ①工作電壓為2．7～5．5 V，可承受的電壓波動范圍較大，可有效克服由于模塊內(nèi)的微型步進電機導致的電源電壓不穩(wěn)定所帶來的干擾，使系統(tǒng)能在一個較寬的電平范圍內(nèi)正常工作。

    ②片內(nèi)資源豐富。ATmega128L存儲器容量大，有128 KB Flash，4 KB E2PROM和4 KB RAM，可以滿足系統(tǒng)復雜的運算和一定量的數(shù)據(jù)存儲要求；53個I／O端口，可滿足系統(tǒng)多傳感輸入和多控制輸出端口要求；I／O口具有大電流輸出的特點，驅(qū)動能力強；內(nèi)置看門狗，提高系統(tǒng)的抗干擾能力。

    ③可在線編程，方便系統(tǒng)的凋試。

3．2紅外線反射電路

    采用帶脈沖調(diào)制功能的紅外線反射傳感器檢測黑線軌跡，電路如圖4所示。電路中鎖相音頻譯碼器LM567既作為紅外線發(fā)射部分的信號發(fā)生電路，也作為接收部分的檢測電路，只有檢測到的輸入信號的頻率和本身的鎖相中心頻率相同時，才使輸出端為低電平。該電路容易濾除外界干擾，電路的穩(wěn)定性和抗干擾能力強，同時可以調(diào)節(jié)譯碼器不同的中心頻率，使得在同一設(shè)備使用多個紅外線傳感器而不會相互干擾。

3．3步進電機驅(qū)動電路

    控制系統(tǒng)中的電機采用VEXTA公司的PX245-01A步進電機，額定電壓4 V，靜態(tài)電流1．2 A，步距角1．8°。步進電機的驅(qū)動電路如圖5所示。達林頓管起功率放大作用，增強步進電機的驅(qū)動能力。電路中使用光電耦合器將控制和驅(qū)動信號加以隔離，有效降低外部干擾對系統(tǒng)的影響，提高系統(tǒng)的可靠性。

3．4輸入與顯示電路

    本設(shè)計采用4×4矩陣掃描非編碼鍵盤方式實現(xiàn)懸掛物體初始點坐標輸入和控制命令輸入。系統(tǒng)控制參數(shù)和懸掛物體運行軌跡圖可在點陣式液晶LCD12864顯示。

3．5無線通信模塊

    本沒計采用無線Modem RF2000實現(xiàn)系統(tǒng)檢測模塊與系統(tǒng)控制模塊之間數(shù)據(jù)和命令的雙向傳輸，電路如圖6所示。RF2000采用Nordic公司的nRF401芯片，采用抗干擾能力強的FSK調(diào)制方式，可以通過TXEN引腳控制收發(fā)方式。無線傳輸過程中，容易受到外界電磁波和步進電機轉(zhuǎn)動產(chǎn)生的電磁干擾，而出現(xiàn)較高的誤碼率。為確保數(shù)據(jù)傳輸?shù)目煽啃?，本設(shè)計通過編碼加強系統(tǒng)的糾錯能力。數(shù)據(jù)或命令以8位數(shù)據(jù)，即一個字節(jié)進行編碼，并分為高4位和低4位進行無線傳輸。以低4位數(shù)據(jù)的傳輸為例。其發(fā)送的數(shù)據(jù)結(jié)構(gòu)各位的定義格式如下：

    該傳輸進行了兩級誤碼校驗。DO～D3是傳輸數(shù)據(jù)的低4位數(shù)據(jù)，D4～D6置O，D7為低4位數(shù)據(jù)的CRC檢驗。

4 軟件設(shè)計

    系統(tǒng)中懸掛物體尋跡采用雙單片機控制方案，黑線檢測模塊和懸掛物體控制模塊各自具有單片機系統(tǒng)，通過通信模塊實現(xiàn)協(xié)同控制，完成懸掛物體尋跡任務(wù)。黑線檢測程序流程和控制模塊程序流程分別如圖7和圖8所示，通信誤碼校正流程如圖9所示。

?

5 測試方法與結(jié)果

    為了使懸掛物體可以沿任意曲線運動，本系統(tǒng)采用圓周曲線作為測試途徑。圓周曲線包含4個方向的轉(zhuǎn)折點，具有一定的代表性，圓周直徑為30 cm，圓周長約94 cm，大于設(shè)計要求的80 cm。測試結(jié)果如表2所列。

結(jié)語

    本設(shè)計以2片ATmega128L單片機分別為黑線檢測和懸掛物體運動控制的核心，仿照雷達掃描跟蹤系統(tǒng)，利用微型步進電機和紅外線傳感器進行黑線的掃描跟蹤，實現(xiàn)系統(tǒng)的連續(xù)黑線和斷續(xù)黑線尋跡。黑線檢測和運動控制兩個核心通過無線數(shù)傳模塊實現(xiàn)檢測數(shù)據(jù)和控制命令的相互通信。測試結(jié)果表明，本系統(tǒng)控制精度高，響應(yīng)時間短，具有較強的斷線尋跡能力。