CPLD的開(kāi)放式四軸運(yùn)動(dòng)控制器的硬件、軟件設(shè)計(jì)

1、【W(wǎng)ord版本下載可任意編輯】 CPLD的開(kāi)放式四軸運(yùn)動(dòng)控制器的硬件、軟件設(shè)計(jì) 運(yùn)動(dòng)控制器是利用高性能微處理器（如DSP）及大規(guī)?？删幊唐骷?shí)現(xiàn)多個(gè)伺服電機(jī)的多軸協(xié)調(diào)控制。目前采用運(yùn)動(dòng)控制器的數(shù)控系統(tǒng)已成為新一代數(shù)控技術(shù)發(fā)展潮流，運(yùn)動(dòng)控制器將成為未來(lái)數(shù)控系統(tǒng)的。 作為運(yùn)動(dòng)控制的部件，運(yùn)動(dòng)控制器普遍采用16位或32位微控制器，其靈活的系統(tǒng)集成方式和高速的指令執(zhí)行速度提高了運(yùn)動(dòng)控制性能、改善了控制系統(tǒng)的精度、增強(qiáng)了系統(tǒng)構(gòu)成的靈活性。如DeltaTau公司的PMAC系列、MEI公司的XMP系列的產(chǎn)品，均采用了高速數(shù)據(jù)信號(hào)處理器（DSP）和現(xiàn)場(chǎng)可編程門陣列（FPGA）技術(shù)，一般可以控制18個(gè)軸。 這些

2、基于PC機(jī)總線的運(yùn)行控制器，雖然因采用高性能微處理器在信息處理速度方面有較大的提高，并在實(shí)際應(yīng)用中提供了靈活的接口，但在使用以及系統(tǒng)集成的時(shí)候，仍然有很多不便，如價(jià)格比較高、應(yīng)用非常復(fù)雜等。并且在構(gòu)造上是封閉的，只能針對(duì)某一類型的應(yīng)用，控制策略單一，很難同時(shí)滿足控制系統(tǒng)在多種應(yīng)用場(chǎng)合中的要求，實(shí)際定制應(yīng)用。 過(guò)去，受計(jì)算機(jī)處理能力的限制，高性能的運(yùn)動(dòng)控制技術(shù)需要在板處理器如單片機(jī)或DSP上實(shí)現(xiàn)，一般PC機(jī)中的微處理器很難同時(shí)完成如軌跡插補(bǔ)運(yùn)算和伺服控制運(yùn)算等任務(wù)。目前PC機(jī)微處理器已經(jīng)采用了更先進(jìn)的工藝技術(shù)，信息處理能力明顯提高，可以滿足高速實(shí)時(shí)運(yùn)動(dòng)控制的要求，硬件支持能力大在增強(qiáng)，并且PC機(jī)

3、良好的軟件開(kāi)發(fā)環(huán)境使構(gòu)造開(kāi)放式運(yùn)動(dòng)控制平臺(tái)成為功可能。本文提出了一種不采用在板處理器而以PC機(jī)微處理器為控制的開(kāi)放式四軸運(yùn)動(dòng)控制器，該運(yùn)動(dòng)控制器采用ALTERA公司的復(fù)雜可編程門陣列（CPLD）EPF6016實(shí)現(xiàn)硬件管理功能，硬件的功能可以通過(guò)軟件配置，而應(yīng)用層的功能如運(yùn)動(dòng)軌跡規(guī)則和伺服控制等均由PC機(jī)完成。 基于CPLD的開(kāi)放式四軸運(yùn)動(dòng)控制器的硬件設(shè)計(jì) 系統(tǒng)硬件構(gòu)造 開(kāi)放式四軸運(yùn)動(dòng)控制器的硬件構(gòu)造如圖1所示。其中，虛線框內(nèi)的部分由ALTERA公司的復(fù)雜可編程門陣列EPF6016實(shí)現(xiàn)。FLEX6000系列器件 EPF6016是ALTERA公司為大容量設(shè)計(jì)提供的一種低成本可編程交織式門陣列，共有

4、16000個(gè)可用門，1320個(gè)邏輯單元，117個(gè)I/O引腳，每個(gè)I/O引腳都有獨(dú)立的三態(tài)輸出使能控制。該器件采用OPEFLEX構(gòu)造，能在的芯片尺寸上保持高性能和高布線率。 器件的基本組成是邏輯單元（LE）。每個(gè)邏輯單元由一個(gè)4輸入查找表、一個(gè)存放器以及作為進(jìn)位鏈和級(jí)連鏈功能的專用通道。每十個(gè)邏輯單元組成一個(gè)邏輯陣列塊（LAB）。器件采用 SRAM構(gòu)造，可以通過(guò)外部EEPROM或控制器實(shí)現(xiàn)在線配置，能使設(shè)計(jì)者在設(shè)計(jì)初期以及設(shè)計(jì)測(cè)試過(guò)程中對(duì)設(shè)計(jì)作靈活的修改，同時(shí)也能夠通過(guò)在線重新配置來(lái)改變其內(nèi)部功能。運(yùn)動(dòng)控制器的硬件功能編程由ALTERA公司提供的MAX+PLUSII開(kāi)發(fā)系統(tǒng)支持，設(shè)計(jì)采用了原理圖

5、輸入方式，設(shè)計(jì)和調(diào)試比較直觀、簡(jiǎn)便。 該運(yùn)動(dòng)控制器的硬件構(gòu)造分為以下幾部分： （1）主機(jī)接口電路：運(yùn)動(dòng)控制器采用了ISA-AT總線接口，同時(shí)設(shè)計(jì)了PC-104接口。數(shù)據(jù)總線寬度為16位，接口功能在EPF6016內(nèi)部實(shí)現(xiàn)，其中包括總線地址譯碼、數(shù)據(jù)和命令鎖存、中斷及復(fù)位等功能。 （2）光電編碼器接口電路：運(yùn)動(dòng)控制器接收四路光電編碼器差分輸入信號(hào)作為位置反應(yīng)，輸入頻率為1MHz，輸入的A、B相信號(hào)經(jīng)過(guò)差動(dòng)接收后，在 EPF6016內(nèi)部經(jīng)過(guò)數(shù)字濾處理后開(kāi)展倍頻和辨向，產(chǎn)生的方向信號(hào)和脈沖信號(hào)進(jìn)入16位加減計(jì)數(shù)器。系統(tǒng)軟件可以計(jì)數(shù)而獲得實(shí)際的位置變化。 （3）模擬量輸出電路：高性能的運(yùn)動(dòng)控制器應(yīng)采用高

6、分辨率的D/A轉(zhuǎn)換器。為了保證模擬量控制信號(hào)的精度，并考慮到模擬量信號(hào)在線上傳輸引起的漂移和電壓降落，運(yùn)動(dòng)控制器和伺服驅(qū)動(dòng)器之間的模擬控制接口信號(hào)至少應(yīng)有12位以上的精度。本文中的運(yùn)動(dòng)控制器采用了低成本、小封裝體積的雙16位串行輸入D/A轉(zhuǎn)換器 AD1866，構(gòu)成雙極性電壓輸出方式。在EPF6016內(nèi)部設(shè)計(jì)了控制4路并發(fā)式并行/串行數(shù)據(jù)轉(zhuǎn)換以及4路D/A地址選擇電路，運(yùn)動(dòng)控制器的模擬量電壓輸出范圍為10V。 （4）數(shù)字量輸入輸出電路：運(yùn)動(dòng)控制的所有I/O信號(hào)均采用光電隔離處理，考慮到I/O并關(guān)信號(hào)可能產(chǎn)生的信號(hào)抖動(dòng)現(xiàn)象，對(duì)每一路I/O信號(hào)都開(kāi)展了相應(yīng)的數(shù)字濾波處理以消除噪聲信號(hào)。控制器設(shè)計(jì)了4

7、0路I/O信號(hào)，其中包括16路專用輸入信號(hào)、2中特殊開(kāi)關(guān)輸入信號(hào)（用于坐標(biāo)測(cè)量或定位的接觸式測(cè)頭信號(hào)和急停開(kāi)關(guān)信號(hào)），另外還設(shè)計(jì)了16路可編程通用I/O信號(hào)（8路輸入/8路輸出）。實(shí)際上，所有的I/O信號(hào)除個(gè)別信號(hào)具有獨(dú)特的功能外，都是開(kāi)放的，可以根據(jù)I/O信號(hào)除個(gè)別信號(hào)具有獨(dú)特功能外，都是開(kāi)放的，可以根據(jù)應(yīng)用的特點(diǎn)設(shè)計(jì)具體的功能。 （5）模擬量輸入電路：對(duì)于一些控制場(chǎng)合，需要檢測(cè)或控制外部狀態(tài)量的變化，運(yùn)動(dòng)控制器也設(shè)計(jì)了相應(yīng)的單端或差動(dòng)式模擬量反應(yīng)輸入通道。系統(tǒng)采用MAXIM公司的8通道、12位轉(zhuǎn)換精度、150kHz采樣頻率的A/D轉(zhuǎn)換器MAX197。各模擬量通道可以獨(dú)立編程選擇輸入范圍：1

8、0V、5V、010V、 05V，A/D轉(zhuǎn)換器的轉(zhuǎn)換基準(zhǔn)采用內(nèi)部基準(zhǔn)。 （6）可編程定時(shí)器：由于在開(kāi)放式運(yùn)動(dòng)控制系統(tǒng)中，插被運(yùn)算和伺服控制都由PC機(jī)完成，這兩個(gè)控制任務(wù)通常不在一個(gè)任務(wù)循環(huán)中處理。一般而言，插補(bǔ)運(yùn)算的周期要比伺服控制的周期長(zhǎng)，因此兩個(gè)任務(wù)需要占用不同的系統(tǒng)資源。由于插補(bǔ)運(yùn)算通常占用PC機(jī)的定時(shí)中斷資源，而伺服控制也是一個(gè)需要定時(shí)的任務(wù)，因此在EPF6016內(nèi)部設(shè)計(jì)了可編程16位定時(shí)器。該定時(shí)器可采用不同的時(shí)鐘源，定時(shí)范圍為0300ms，分辨率為70ns，定時(shí)器產(chǎn)生的溢出動(dòng)作可以向PC機(jī)申請(qǐng)中斷。 （7）同步工作電路：在運(yùn)動(dòng)控制系統(tǒng)中，各控制軸同步運(yùn)行是一個(gè)很重要的要求，因此在EP

9、F6016內(nèi)部設(shè)計(jì)了同步控制電路的和專門的控制字，支持多塊運(yùn)動(dòng)控制器控制輸出同步刷新、反應(yīng)計(jì)數(shù)值同步讀取等操作。 （8）硬件看門狗電路：在運(yùn)動(dòng)控制器中采用了DALLAS公司的看門狗復(fù)位及電壓監(jiān)控芯片DS1232，以監(jiān)測(cè)系統(tǒng)的軟硬件運(yùn)行情況。當(dāng)系統(tǒng)軟件運(yùn)行死機(jī)的時(shí)候，看門狗電路產(chǎn)生信號(hào)復(fù)位系統(tǒng)，保證整個(gè)系統(tǒng)的可靠性?？撮T狗定時(shí)時(shí)間可以編程設(shè)置為300ms、600ms、1.2s。 從硬件構(gòu)造的組成特點(diǎn)可以看出，系統(tǒng)的組成是其有可重新配置特點(diǎn)的CPLD EPF6016，它實(shí)現(xiàn)了幾乎所有外圍電路管理功能，而其它的電路都屬于標(biāo)準(zhǔn)的輔助電路。因此系統(tǒng)在構(gòu)造上具有典型的開(kāi)放性，這對(duì)實(shí)現(xiàn)軟件的開(kāi)放是一個(gè)很好的

10、支持。 基于CPLD的開(kāi)放式四軸運(yùn)動(dòng)控制器的軟件設(shè)計(jì) 運(yùn)動(dòng)控制器軟件設(shè)計(jì) 運(yùn)動(dòng)控制器的軟件采用Borland C+語(yǔ)言編寫(xiě)，可以按照庫(kù)函數(shù)的方式調(diào)用。根據(jù)實(shí)時(shí)運(yùn)動(dòng)控制的特點(diǎn)硬件資源的構(gòu)造，函數(shù)庫(kù)分為兩類： （1）控制運(yùn)動(dòng)控制器硬件操作的函數(shù)庫(kù)。包括針對(duì)運(yùn)動(dòng)控制器硬件基本操作的函數(shù)，通過(guò)調(diào)用這些函數(shù)可以充分利用硬件資源，實(shí)現(xiàn)定制的應(yīng)用。運(yùn)動(dòng)控制器上的各個(gè)硬件功能的存取操作是通過(guò)一組讀寫(xiě)控制命令實(shí)現(xiàn)的，每一個(gè)控制命令占用一個(gè)PC機(jī)I/O空間地址，對(duì)每一個(gè)地址分別開(kāi)展讀或?qū)懖僮鲗a(chǎn)生不同的功能。硬件操作函數(shù)庫(kù)按照C+語(yǔ)言類的方式構(gòu)造，每個(gè)命令都是以運(yùn)動(dòng)控制器硬件操作類的公有成員函數(shù)形式存在。這些命令主要實(shí)現(xiàn)以下功能： 控制光電編碼器脈沖計(jì)數(shù)器，讀取或去除計(jì)數(shù)值; 設(shè)置運(yùn)動(dòng)控制器的工作方式以及配置系統(tǒng)的各個(gè)硬件資源; 開(kāi)關(guān)量輸入輸出操作，實(shí)現(xiàn)包括通用I/O和專用I/O的查詢和設(shè)置、控制器硬件資源工作狀態(tài)查詢等功能; 模擬量控制命令，用于控制D/A轉(zhuǎn)換器和A/D轉(zhuǎn)換器實(shí)現(xiàn)模擬量輸出和模擬信號(hào)采集等。 （2）定制應(yīng)用算法函數(shù)庫(kù)。根據(jù)實(shí)際應(yīng)用的要求，以控制運(yùn)動(dòng)控制器硬件操作的函數(shù)庫(kù)為根底，可以有針對(duì)性地設(shè)計(jì)應(yīng)用算法函數(shù)。本文以運(yùn)動(dòng)控制為例設(shè)計(jì)了針對(duì)運(yùn)動(dòng)控制的算法函數(shù)庫(kù)，實(shí)現(xiàn)運(yùn)動(dòng)規(guī)劃、伺服控制等功能。其它控制算法和功能也可以在此根底上進(jìn)一步擴(kuò)展。運(yùn)動(dòng)控制算法函數(shù)庫(kù)的各命令也采