運動控制系統(tǒng)已被廣泛應(yīng)用于工業(yè)控制領(lǐng)域。近年來,工業(yè)控制對運動控制系統(tǒng)的要求越來越高。傳統(tǒng)的基于PC及低端微控制器日漸暴露出高成本、高消耗、低可靠等問題,已經(jīng)不能滿足現(xiàn)代制造的要求 。隨著嵌入式技術(shù)的日益成熟,嵌人式運動控制器已經(jīng)初露鋒芒?;?a target="_blank">ARM技術(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通信接口進(jìn)行連接。
軟件方面在硬件平臺的基礎(chǔ)上移植S3C2440實時嵌入式操作系統(tǒng),設(shè)計Boot Loader、外設(shè)驅(qū)動以及運動控制系統(tǒng)的應(yīng)用程序。采用上述的軟硬件平臺,嵌入式運動控制器可以達(dá)到開放性能好、精度高的要求。本嵌入式四軸運動控制器的結(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)來進(jìn)行人機界面的顯示、I/O的管理、任務(wù)問的通信、指令的編譯等工作。PCL6045BL運動控制模塊主要負(fù)責(zé)位置控制,插補驅(qū)動,速度控制。用戶的指令通過S3C2440指令編譯系統(tǒng)的編譯,通過與PCL6045BL之問的專用通信接口來控制DSP運動控制芯片發(fā)出脈沖以達(dá)到使伺服電機高速運行。
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)生脈沖控制步進(jìn)電機或脈沖驅(qū)動型伺服電機的CMOS大規(guī)模集成芯片,可提供多種輸出運動控制功能,包括連續(xù)、定長、回原點等輸出方式。PCL6045BL可以實現(xiàn)2~4軸線性插補及任意兩軸圓弧插補。在這種主從結(jié)構(gòu)框架基礎(chǔ)上,主CPU S3C2440主要負(fù)責(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總線上的幾個地址來進(jìn)行指令和數(shù)據(jù)的傳輸。PCL6045BL每個軸的內(nèi)部寄存器地址由A0、A1 和A2地址線輸人決定,其控制地址范圍由輸入端子A3和A4進(jìn)行選擇。因此在這種主從結(jié)構(gòu)的設(shè)計中,ARM與PCL6045BL的連接如圖3所示。
ARM DSP的嵌入式四軸運動控制器設(shè)計圖3 PCL6045BL與S3C2440的接口電路
2.3 I/O接口電路
嵌入式四軸運動控制器與伺服電機之間是通過I/O接口電路進(jìn)行連接的。I/O接口電路主要任務(wù)是完成輸入信號的光電隔離以及對輸出脈沖的驅(qū)動。設(shè)計中采用光電耦合器將PCL6045BL芯片與后面的伺服電機驅(qū)動器以及其他控制反饋等線路隔離。由于光耦合器輸入輸出問互相隔離,電信號傳輸具有單向性等特點,因而具有良好的電絕緣能力和抗干擾能力。又由于光耦合器的輸入端屬于電流型工作的低阻元件,因而具有很強的共模抑制能力。將PCL6045BL的輸出信號(如CP、CW等)和輸入信號(如報警、限位等)都使用光耦器件與PCL6045BL隔離,這樣能有效地防止干擾信號進(jìn)入主芯片損壞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)加電后運行的段代碼,負(fù)責(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主要進(jìn)行定義入口、設(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寄存器和堆棧空間。一個任務(wù),也叫一個線程,是一個簡單的程序,該程序可以認(rèn)為CPU完全只屬于自己。在本設(shè)計中將任務(wù)劃分為人機界面的設(shè)計、數(shù)控指令編譯解釋、伺服單元采集任務(wù)、狀態(tài)監(jiān)視等。μC/OS-II可以按照優(yōu)先級啟動各個任務(wù),并通過內(nèi)核來完成任務(wù)之間的調(diào)度。系統(tǒng)的基本流程如圖5所示。
S3C2440根據(jù)系統(tǒng)的應(yīng)用程序?qū)χ噶钸M(jìn)行解釋,調(diào)用運動控制函數(shù),繼而PCL6045BL發(fā)出脈沖控制伺服電機去控制執(zhí)行機構(gòu)動作,實現(xiàn)運動控制的結(jié)果。
ARM DSP的嵌入式四軸運動控制器設(shè)計圖5 用戶程序流程
3.4 NC代碼解釋
運動控制器接受來自上位機發(fā)送過來的加工文件,但加工文件指令在程序中不能直接被識別,在執(zhí)行指令之前必須先對其進(jìn)行解析譯碼。解釋器的主要功能就是將用戶程序以程序段為處理單位,將程序中的輪廓信息、運行速度和輔助功能信息,轉(zhuǎn)換成嵌入式運動控制器能夠執(zhí)行的格式。解釋過程主要包括數(shù)控文件的讀入、詞法分析、語法分析以及加工信息存儲數(shù)據(jù)結(jié)構(gòu)等過程,如圖6所示。
ARM DSP的嵌入式四軸運動控制器設(shè)計圖6 程序處理流程
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ù)上面所給的代碼可以完成如圖7所示的多點之間直線插補的功能。
ARM DSP的嵌入式四軸運動控制器設(shè)計圖7 多線段直線插補運動軌跡
5 結(jié)語
該運動控制器的硬件結(jié)構(gòu)是基于微處理器S3C2440和PCL6045BL運動控制芯片設(shè)計的,它較好地發(fā)揮了ARM處理器的高性能、低成本和運動控制芯片的高可靠性、開發(fā)周期短的優(yōu)點;在控制器硬件平臺上移植μC/OS-II實時操作系統(tǒng)既能使整個軟件系統(tǒng)結(jié)構(gòu)簡結(jié)、層次清晰,又能很好地達(dá)到運動控制實時性的要求。
評論
查看更多