基于S3C2440處理器與專用DSP的嵌入式四軸運動控制系統(tǒng)設(shè)計

運動控制系統(tǒng)已被廣泛應(yīng)用于工業(yè)控制領(lǐng)域。近年來，工業(yè)控制對運動控制系統(tǒng)的要求越來越高。傳統(tǒng)的基于PC及低端微控制器日漸暴露出高成本、高消耗、低可靠等問題，已經(jīng)不能滿足現(xiàn)代制造的要求 。隨著嵌入式技術(shù)的日益成熟，嵌人式運動控制器已經(jīng)初露鋒芒?；贏RM技術(shù)的微處理器具有體積小、低成本、低功耗的特點，決定其在運動控制領(lǐng)域具有良好的發(fā)展前景。

PCL6045BL是一種新型專用DSP運動控制芯片，它具有強大的數(shù)據(jù)處理能力和較高的運行速度，可以實現(xiàn)高精度的多軸伺服控制。為解決精密制造對低成本、可移植性強的通用型多軸數(shù)控系統(tǒng)的迫切需求，文中給出一種基于ARM 微處理器S3C2440與DSP運動控制芯片PCL6045BL構(gòu)成的嵌入式四軸運動控制器。該運動控制器具有高性能、低成本、體積小、可獨立運行等特點，可以滿足運動控制系統(tǒng)高速、高精度的 要求。它可廣泛應(yīng)用于雕刻機、機器人、繡花機以及數(shù)控加工等工業(yè)控制領(lǐng)域。

為解決精密制造對低成本、可移植性強的通用型多軸數(shù)控系統(tǒng)的迫切需求，給出一種基于ARM微處理器S3C2440和專用DSP運動控制芯片PCL65045BL組合的嵌入式四軸運動控制器。硬件上該控制器采用ARM DSP的主從式雙CPU結(jié)構(gòu)，結(jié)合ARM在人機界面顯示、通信接口方面的優(yōu)勢以及PCL6045BL高控制精度的優(yōu)點。軟件上在S3C2440上移植μC/OS-II實時操作系統(tǒng)來管理運動控制系統(tǒng)。該控制系統(tǒng)通用性較強，可廣泛應(yīng)用于雕刻機、機器人、繡花機以及數(shù) 控加工等工業(yè)控制領(lǐng)域。

1 系統(tǒng)總體設(shè)計

嵌入式四軸運動控制器主要由硬件部分和軟件部分構(gòu)成。

硬件主要包括S3C2440嵌入式主控板和PCL6045BL運動控制板兩個部分。S3C2440嵌入式主控板和PCL6045BL運動控制板之間通過通用的IDE通信接口進行連接。

軟件方面在硬件平臺的基礎(chǔ)上移植S3C2440實時嵌入式操作系統(tǒng)，設(shè)計Boot Loader、外設(shè)驅(qū)動以及運動控制系統(tǒng)的應(yīng)用程序。采用上述的軟硬件平臺，嵌入式運動控制器可以達到開放性能好、精度高的要求。本嵌入式四軸運動控制器的結(jié)構(gòu)如圖1所示。

ARM具有豐富的片內(nèi)外圍電路，如USB接口、IIS接口、LCD控制器等，在人機界面的顯示、通信接口以及系統(tǒng)移植方面具有更強大的功能。PCL6045BL運動控制芯片速度快，可靠性高，性能好，在運動控制方面有很大的優(yōu)勢。

實時操作系統(tǒng)μC/OS-II包含了實時內(nèi)核、任務(wù)管理、時間管理、任務(wù)間通信同步和內(nèi)存管理等功能，可以使各個任務(wù)獨立工作，互不干涉，很容易實現(xiàn)準(zhǔn)時而且無誤地執(zhí)行，使實時應(yīng)用程序的設(shè)計和擴展變得容易，使應(yīng)用程序的設(shè)計過程大為減化 。將S3C2440處理器、PCL6045BL 以及μC/OS-II三者的優(yōu)勢應(yīng)用到本嵌入式四軸運動控制器中可以使其具有強大的功能，并縮短開發(fā)時間。

本嵌入式四軸運動控制器以S3C2440為主控平臺，在ARM上移植μC/OS-II實時操作系統(tǒng)來進行人機界面的顯示、I/O的管理、任務(wù)問的通信、指令的編譯等工作。PCL6045BL運動控制模塊主要負責(zé)位置控制，插補驅(qū)動，速度控制。用戶的指令通過S3C2440指令編譯系統(tǒng)的編譯，通過與PCL6045BL之問的專用通信接口來控制DSP運動控制芯片發(fā)出脈沖以達到使伺服電機高速運行。

2 系統(tǒng)硬件設(shè)計

2.1 系統(tǒng)硬件平臺設(shè)計

在控制系統(tǒng)中，以S3C2440處理器為主控，PCL6045BL運動控制芯片為從CPU，構(gòu)建的嵌入式運動控制器結(jié)構(gòu)如圖2所示。

ARM DSP的嵌入式四軸運動控制器設(shè)計圖2 系統(tǒng)硬件

S3C2440是一款16/32位ARM920T RISC處理器，它實現(xiàn)了MMU、AMBA總線和獨立的16 KB指令和16 KB數(shù)據(jù)哈佛結(jié)構(gòu)的緩存，每個緩存均為8個字長度的流水線。S3C2440提供全面的、通用的片上外設(shè)，不需要配置額外的部件。PCL6045BL運動控制芯片，由NPM公司生產(chǎn)，是一種通過總線接收CPU命令、并產(chǎn)生脈沖控制步進電機或脈沖驅(qū)動型伺服電機的CMOS大規(guī)模集成芯片，可提供多種輸出運動控制功能，包括連續(xù)、定長、回原點等輸出方式。PCL6045BL可以實現(xiàn)2~4軸線性插補及任意兩軸圓弧插補。在這種主從結(jié)構(gòu)框架基礎(chǔ)上，主CPU S3C2440主要負責(zé)數(shù)據(jù)的存儲、人機界面的顯示、網(wǎng)絡(luò)通信等管理工作。從CPU PCL6045BL輸出的脈沖發(fā)送給4個軸的伺服驅(qū)動器。S3C2440只需要通過發(fā)送簡單的指令給PCL6045BL，便可實現(xiàn)各種控制功能。

2.2 ARM 與PCL6045BL的連接

PCL6045 BL與ARM的通信是通過讀寫I/O總線上的幾個地址來進行指令和數(shù)據(jù)的傳輸。PCL6045BL每個軸的內(nèi)部寄存器地址由A0、A1 和A2地址線輸人決定，其控制地址范圍由輸入端子A3和A4進行選擇。因此在這種主從結(jié)構(gòu)的設(shè)計中，ARM與PCL6045BL的連接如圖3所示。

ARM DSP的嵌入式四軸運動控制器設(shè)計圖3 PCL6045BL與S3C2440的接口電路

2.3 I/O接口電路

嵌入式四軸運動控制器與伺服電機之間是通過I/O接口電路進行連接的。I/O接口電路主要任務(wù)是完成輸入信號的光電隔離以及對輸出脈沖的驅(qū)動。設(shè)計中采用光電耦合器將PCL6045BL芯片與后面的伺服電機驅(qū)動器以及其他控制反饋等線路隔離。由于光耦合器輸入輸出問互相隔離，電信號傳輸具有單向性等特點，因而具有良好的電絕緣能力和抗干擾能力。又由于光耦合器的輸入端屬于電流型工作的低阻元件，因而具有很強的共模抑制能力。將PCL6045BL的輸出信號(如CP、CW等)和輸入信號(如報警、限位等)都使用光耦器件與PCL6045BL隔離，這樣能有效地防止干擾信號進入主芯片損壞PCL6045BL。

3 軟件設(shè)計

系統(tǒng)軟件部分由μC/OS-II實時嵌入式操作系統(tǒng)及相關(guān)應(yīng)用軟件組成。μC/OS-II實時嵌入式操作系統(tǒng)僅僅提供了一個任務(wù)調(diào)度的實時內(nèi)核，因而需要自行開發(fā)一系列與系統(tǒng)運行相關(guān)的設(shè)備驅(qū)動程序、API函數(shù)及應(yīng)用程序，才能將μC/OS-II擴展為一個完整、實用的實時操作系統(tǒng)。

3.1 Boot Loader的設(shè)計

嵌入式系統(tǒng)中，通常并沒有像BIOS那樣的固件程序，因此整個系統(tǒng)的加載啟動任務(wù)就完全由Boot Loader來完成。Boot Loader是系統(tǒng)加電后運行的段代碼，負責(zé)初始化系統(tǒng)并啟動操縱系統(tǒng)，相當(dāng)于PC機的程序。Boot Loader初始化硬件設(shè)備，建立內(nèi)存空間的映射圖，為終調(diào)用操作系統(tǒng)內(nèi)核準(zhǔn)備好正確的環(huán)境。

Boot Loader分為階段1和階段2兩個部分，與CPU核以及存儲設(shè)備密切相關(guān)的處理工作通常都放在階段1中，且可以用匯編語言來實現(xiàn);而階段2則通常用C語言來實現(xiàn)一般的流程以及對板級的一些驅(qū)動支持。

階段1主要進行定義入口、設(shè)置中斷向量、系統(tǒng)寄存器配置、初始化寄存器等操作。而階段2主要完成調(diào)用初始化函數(shù)、初始化閃存設(shè)備、初始化內(nèi)存分配函數(shù)等操作。Boot Loader是嵌入式系統(tǒng)軟件開發(fā)的個環(huán)節(jié)，把實時操作系統(tǒng)和硬件平臺緊密地結(jié)合起來，對于嵌入式系統(tǒng)的軟件開發(fā)尤為重要。

3.2 μC/OS-II在S3132440的移植

嵌入式實時操作系統(tǒng)μC/OS-II是一個源代碼公開的多任務(wù)實時操作系統(tǒng)內(nèi)核，它簡化了應(yīng)用軟件的設(shè)計，使控制系統(tǒng)的實時性得到保障。良好的多任務(wù)設(shè)計，有助于提高控制系統(tǒng)的穩(wěn)定性和可靠性。所謂移植，就是通過修改操作系統(tǒng)內(nèi)核與處理器相關(guān)部分的源代碼，使一個實時內(nèi)核能在微處理器或微控制器上運行。μC/OS-II的文件系統(tǒng)結(jié)構(gòu)包括代碼部分，配置代碼部分，處理器相關(guān)代碼部分，如圖4所示。其中處理器相關(guān)代碼部分包括OS_CPU.H，OS_CPU.A.ASM，OS_CPU.C.C 3個文件。將μC/OS-II移植到S3C2440只需要修改與處理器相關(guān)的代碼即可。

ARM DSP的嵌入式四軸運動控制器設(shè)計

3.3 系統(tǒng)應(yīng)用程序設(shè)計

實時應(yīng)用程序的設(shè)計過程包括如何把問題分割為多個子任務(wù)，每個子任務(wù)都是整個系統(tǒng)的一部分，都被賦予一定的優(yōu)先級，有自己的一套CPU寄存器和堆?？臻g。一個任務(wù)，也叫一個線程，是一個簡單的程序，該程序可以認為CPU完全只屬于自己。在本設(shè)計中將任務(wù)劃分為人機界面的設(shè)計、數(shù)控指令編譯解釋、伺服單元采集任務(wù)、狀態(tài)監(jiān)視等。μC/OS-II可以按照優(yōu)先級啟動各個任務(wù)，并通過內(nèi)核來完成任務(wù)之間的調(diào)度。。

S3C2440根據(jù)系統(tǒng)的應(yīng)用程序?qū)χ噶钸M行解釋，調(diào)用運動控制函數(shù)，繼而PCL6045BL發(fā)出脈沖控制伺服電機去控制執(zhí)行機構(gòu)動作，實現(xiàn)運動控制的結(jié)果。

3.4 NC代碼解釋

運動控制器接受來自上位機發(fā)送過來的加工文件，但加工文件指令在程序中不能直接被識別，在執(zhí)行指令之前必須先對其進行解析譯碼。解釋器的主要功能就是將用戶程序以程序段為處理單位，將程序中的輪廓信息、運行速度和輔助功能信息，轉(zhuǎn)換成嵌入式運動控制器能夠執(zhí)行的格式。解釋過程主要包括數(shù)控文件的讀入、詞法分析、語法分析以及加工信息存儲數(shù)據(jù)結(jié)構(gòu)等過程。

ARM DSP的嵌入式四軸運動控制器 程序處理流程

4 實例分析

上位機通過RS485總線與S3C2440連接，把NC指令文件輸入到ARM 中，經(jīng)過NC代碼解釋器，變成PCL6045BL能夠識別的代碼，從而完成規(guī)定的運動控制功能。用NC代碼編寫如下加工程序：

N001 COO X15 Y25//起始點選定

N002 G18//XY平面選擇

N003 G90 G01 X15 Y5//準(zhǔn)備直線插補

N004 X30 Y5//(15，5)到(30，5)

N005 X30 Y15//前行至點(30，15)

N006 X45 Y15//前行至點(45，15)

N007 X45 Y5//前行至點(45，5)

N008 X60 Y5//前行至點(60，5)

N009 X60 Y25//前行至點(60，25)

N010 X15 Y25//回到始點(15，25)

根據(jù)上面所給的代碼可以完成所示的多點之間直線插補的功能。

ARM DSP的嵌入式四軸運動控制器設(shè)計多線段直線插補運動軌跡

5 結(jié)語

該運動控制器的硬件結(jié)構(gòu)是基于微處理器S3C2440和PCL6045BL運動控制芯片設(shè)計的，它較好地發(fā)揮了ARM處理器的高性能、低成本和運動控制芯片的高可靠性、開發(fā)周期短的優(yōu)點;在控制器硬件平臺上移植μC/OS-II實時操作系統(tǒng)既能使整個軟件系統(tǒng)結(jié)構(gòu)簡結(jié)、層次清晰，又能很好地達到運動控制實時性的要求。