摘 要: 介紹了一種基于FPGA的圓光柵編碼器數(shù)據(jù)采集系統(tǒng)的設(shè)計(jì)方法,。通過分析圓光柵的實(shí)際工作情況,將系統(tǒng)分為三大模塊,,詳細(xì)闡述了濾波模塊實(shí)現(xiàn)消除高頻信號(hào)干擾,,計(jì)數(shù)模塊實(shí)現(xiàn)四倍頻、辨向與脈沖計(jì)數(shù),,以及數(shù)據(jù)通信模塊實(shí)現(xiàn)跨時(shí)鐘域數(shù)據(jù)傳輸功能的具體方法,。最后通過Modelsim仿真驗(yàn)證了系統(tǒng)設(shè)計(jì)的可行性與可靠性。本系統(tǒng)具有高集成,、可擴(kuò)展,、便于移植的特點(diǎn),可廣泛應(yīng)用于相關(guān)領(lǐng)域,。
關(guān)鍵詞: 現(xiàn)場可編程門陣列,;圓光柵;數(shù)字濾波,;脈沖計(jì)數(shù),;跨時(shí)鐘域
光電式旋轉(zhuǎn)編碼器是檢測轉(zhuǎn)速或轉(zhuǎn)角的元件,旋轉(zhuǎn)編碼器與電動(dòng)機(jī)相連,,當(dāng)電動(dòng)機(jī)轉(zhuǎn)動(dòng)時(shí),,帶動(dòng)編碼器旋轉(zhuǎn),產(chǎn)生轉(zhuǎn)速或轉(zhuǎn)角信號(hào),。旋轉(zhuǎn)編碼器可分為絕對(duì)式和增量式兩種[1],。
圓光柵作為增量式光電編碼器的一種,以其體積小,、精度高,、響應(yīng)速度快、價(jià)格相對(duì)較低以及性能穩(wěn)定等優(yōu)點(diǎn),,被廣泛應(yīng)用到光電經(jīng)緯儀,、機(jī)器人、數(shù)控機(jī)床和高精度閉環(huán)調(diào)速系統(tǒng)等諸多領(lǐng)域,。
現(xiàn)場可編程門陣列FPGA(Field Programmable Gate Array)是在PAL,、GAL,、CPLD等可編程器件的基礎(chǔ)上進(jìn)一步發(fā)展的產(chǎn)物[2],,它既繼承了ASIC的大規(guī)模,、高集成度及高可靠性的優(yōu)點(diǎn),又克服了普通ASIC設(shè)計(jì)周期長,、成本大和靈活性差的特點(diǎn),,可以方便地實(shí)現(xiàn)對(duì)電路的重新設(shè)計(jì)或修改、完成復(fù)雜的時(shí)序和組合邏輯電路功能,,增強(qiáng)了系統(tǒng)的靈活性,、通用性和可靠性。
本文以FPGA為開發(fā)平臺(tái),,設(shè)計(jì)了一種圓光柵數(shù)據(jù)采集系統(tǒng),,并詳細(xì)介紹了該系統(tǒng)的實(shí)現(xiàn)方法。該方法充分利用FPGA大規(guī)模邏輯資源,、高集成度,、高穩(wěn)定性且易編程的特點(diǎn),完成了對(duì)圓光柵輸出信號(hào)的濾波,、計(jì)數(shù)及數(shù)據(jù)傳輸功能,。
1 系統(tǒng)相關(guān)原理及結(jié)構(gòu)
增量式圓光柵編碼器一般有A相、B相及Z相3個(gè)輸出,。A相,、B相信號(hào)包含了圓光柵編碼器的旋轉(zhuǎn)方向、旋轉(zhuǎn)速率等信息,。當(dāng)圓光柵編碼器被檢測對(duì)象帶動(dòng)旋轉(zhuǎn)時(shí),,會(huì)輸出相位差為90°的A相和B相兩路數(shù)字脈沖信號(hào)[3],如圖1所示,。當(dāng)圓光柵編碼器順時(shí)針正向旋轉(zhuǎn)時(shí),,A相信號(hào)的相位超前B相信號(hào)90°;當(dāng)圓光柵編碼器逆時(shí)針反向旋轉(zhuǎn)時(shí),,則B相信號(hào)超前A相信號(hào)90°,。A相和B相輸出的脈沖個(gè)數(shù)與被測角位移變化量成線性關(guān)系。Z相信號(hào)功能主要是用于測量的同步或調(diào)零,,光電角度編碼器每旋轉(zhuǎn)一圈,,輸出一個(gè)Z相脈沖信號(hào)[4]。利用Z相信號(hào),,可以矯正系統(tǒng)的計(jì)數(shù)數(shù)據(jù),,有效地消除系統(tǒng)的累計(jì)誤差。
本文根據(jù)圓光柵編碼器的工作原理,,采用自頂向下的設(shè)計(jì)思想,,設(shè)計(jì)了一種有效的圓光柵編碼器脈沖信號(hào)數(shù)據(jù)采集系統(tǒng),。其結(jié)構(gòu)原理圖如圖2所示,系統(tǒng)分為濾波模塊,、計(jì)數(shù)模塊及數(shù)據(jù)通信模塊三大模塊,。其中,濾波模塊的主要功能是消除高頻干擾脈沖對(duì)系統(tǒng)計(jì)數(shù)的影響,,保證計(jì)數(shù)的準(zhǔn)確性,;計(jì)數(shù)模塊主要完成4倍頻、辨向和計(jì)數(shù)功能,;數(shù)據(jù)通信模塊主要負(fù)責(zé)將數(shù)據(jù)傳輸?shù)紽PGA外部其他數(shù)據(jù)處理芯片,,避免跨時(shí)鐘域數(shù)據(jù)傳輸帶來的各種不利影響。
2 系統(tǒng)設(shè)計(jì)
2.1 濾波模塊的設(shè)計(jì)
由于工業(yè)現(xiàn)場存在各種不確定性因素,,圓光柵數(shù)據(jù)輸出容易受到干擾,,其中最顯著的是運(yùn)動(dòng)過程中的機(jī)械振動(dòng)和現(xiàn)場環(huán)境中的電磁干擾。這兩者均會(huì)使圓光柵編碼器的輸出脈沖產(chǎn)生高頻脈沖毛刺,,導(dǎo)致脈沖計(jì)數(shù)錯(cuò)誤,,從而嚴(yán)重影響測量精度[5]。圖3給出了干擾波形的示意圖,,這種干擾一般發(fā)生在A相信號(hào)或者B相信號(hào)的電平發(fā)生改變時(shí),。從圖3中正轉(zhuǎn)干擾圖可以看到,當(dāng)圓光柵正轉(zhuǎn)時(shí),,A相信號(hào)和B相信號(hào)先后從低電平跳變?yōu)楦唠娖?,且B相信號(hào)落后90°。此時(shí),,由于機(jī)械振動(dòng),,A相信號(hào)產(chǎn)生了高頻脈沖輸出,即A相信號(hào)的電平在相對(duì)較短的時(shí)間內(nèi)變化了5次,。根據(jù)編碼器信號(hào)輸出關(guān)系可知,,第1、3,、5次電平變化代表了圓光柵編碼器正轉(zhuǎn),;而2、4次電平變化則代表著圓光柵編碼器的反轉(zhuǎn),,這些高頻干擾脈沖影響了計(jì)數(shù)和測量的正確性,。
由于干擾所產(chǎn)生的脈沖頻率一般都遠(yuǎn)高于圓光柵正常工作時(shí)所輸出的脈沖頻率,因此本文采用了一種高頻數(shù)字計(jì)數(shù)濾波方法,。即在已知系統(tǒng)最高轉(zhuǎn)速的情況下,,根據(jù)所使用圓光柵的刻線數(shù),計(jì)算出最高轉(zhuǎn)速下圓光柵輸出的脈沖頻率,,并以此頻率為臨界點(diǎn),,將頻率高于這個(gè)臨界點(diǎn)的脈沖視為干擾脈沖濾除,。
例如,電機(jī)帶動(dòng)圓光柵轉(zhuǎn)動(dòng)的最高速度為20 r/min,,圓光柵輸出信號(hào)經(jīng)過讀數(shù)頭處理后,,每轉(zhuǎn)輸出6×106個(gè)脈沖,有效脈沖最高頻率應(yīng)為2 MHz,。FPGA工作時(shí)鐘設(shè)定為50 MHz,,則一個(gè)光柵信號(hào)有效脈沖的高電平或者低電平至少應(yīng)持續(xù)12個(gè)FPGA工作時(shí)鐘,。持續(xù)時(shí)間低于12個(gè)工作時(shí)鐘的脈沖超出了最高轉(zhuǎn)速所能產(chǎn)生的脈沖頻率,,因此被視為干擾脈沖并予以濾除;持續(xù)時(shí)間大于等于12個(gè)工作時(shí)鐘的脈沖將被輸送到FPGA的脈沖計(jì)數(shù)單元,。利用這種方法可有效去除高頻脈沖干擾對(duì)計(jì)數(shù)的影響,,保證系統(tǒng)的測量精度。
2.2 計(jì)數(shù)模塊的設(shè)計(jì)
目前,,常見的增量式光電編碼器數(shù)據(jù)采集系統(tǒng)均采用4倍頻或二倍頻的方法來提高測量精度,。而一般系統(tǒng)所采取的方法是將A相信號(hào)與B相信號(hào)進(jìn)行異或運(yùn)算,所得的結(jié)果即為經(jīng)過二倍頻的信號(hào),;若要得到4倍頻,,則需要再進(jìn)行一步異或運(yùn)算。該方法的優(yōu)點(diǎn)是實(shí)現(xiàn)簡單,,而缺點(diǎn)是對(duì)器件和編碼器輸出信號(hào)有比較苛刻的要求,。在時(shí)序邏輯上,A相信號(hào)和B相信號(hào)必須滿足器件建立和保持的時(shí)間要求,,這樣就限制了器件所能實(shí)現(xiàn)的工作頻率,,影響了整個(gè)系統(tǒng)的實(shí)時(shí)性。
而在辨識(shí)編碼器轉(zhuǎn)動(dòng)方向上,,一般系統(tǒng)都是將A相信號(hào)(或者B相信號(hào))作為基準(zhǔn)信號(hào),,在其電平變化的時(shí)刻判斷B相信號(hào)(或者A相信號(hào))電平的正負(fù),以此來進(jìn)行方向辨識(shí)與脈沖計(jì)數(shù),。這種方法抗干擾能力差,,外界干擾所產(chǎn)生的脈沖會(huì)很容易使方向判別錯(cuò)誤,同時(shí)導(dǎo)致脈沖計(jì)數(shù)錯(cuò)誤,,產(chǎn)生隨機(jī)誤差,,對(duì)整個(gè)系統(tǒng)的精度和準(zhǔn)確度造成巨大影響。
本系統(tǒng)充分分析了增量式圓光柵編碼器信號(hào)輸出的邏輯關(guān)系,,設(shè)計(jì)了一種以有限狀態(tài)機(jī)為核心的計(jì)數(shù)模塊,,來完成對(duì)編碼器輸出信號(hào)的4倍頻、方向辨識(shí)及脈沖計(jì)數(shù),。如圖4所示,,將圓光柵輸出信號(hào)A和B的正負(fù)用1和0表示,,則A相信號(hào)和B相信號(hào)一共有A1B1、A1B0,、A0B1,、A0B0這4個(gè)狀態(tài)組合。當(dāng)圓光柵編碼器輸出狀態(tài)按照A0B0→A1B0→A1B1→A0B1→A0B0這個(gè)順序變化時(shí),,代表圓光柵編碼器正轉(zhuǎn),;當(dāng)圓光柵編碼器輸出狀態(tài)按照A0B1→A1B1→A1B0→A0B0→A0B1順序時(shí),代表圓光柵編碼器反轉(zhuǎn),。
計(jì)數(shù)模塊內(nèi)部利用兩個(gè)寄存器分別存儲(chǔ)當(dāng)前狀態(tài)和下一狀態(tài),,當(dāng)前狀態(tài)和下一狀態(tài)值相同時(shí),狀態(tài)機(jī)處在等待的狀態(tài)且不進(jìn)行任何操作,;當(dāng)圓光柵編碼器輸出信號(hào)A,、B發(fā)生變化時(shí),計(jì)數(shù)模塊會(huì)將其存儲(chǔ)到下一狀態(tài)寄存器中,。由于圓光柵編碼器可能在任意時(shí)刻改變轉(zhuǎn)動(dòng)方向,,而有限狀態(tài)機(jī)也可以根據(jù)A相及B相信號(hào)相應(yīng)的邏輯關(guān)系及兩個(gè)寄存器中的狀態(tài)值來判斷出當(dāng)前的狀態(tài)變化所代表的編碼器的轉(zhuǎn)動(dòng)方向,并進(jìn)行相應(yīng)的加或減運(yùn)算,。然后將下一狀態(tài)寄存器中的值賦給當(dāng)前狀態(tài)寄存器,,此時(shí),兩個(gè)寄存器中值再次相同,,有限狀態(tài)機(jī)等待下一次A或B信號(hào)的改變觸發(fā)下一次操作,。至此,完成了編碼器轉(zhuǎn)動(dòng)方向的辨識(shí)和脈沖計(jì)數(shù),。
由于A相信號(hào)和B相信號(hào)的電平變化均會(huì)引起有限狀態(tài)機(jī)中兩個(gè)狀態(tài)寄存器的值不一致,,從而觸發(fā)狀態(tài)機(jī)進(jìn)行相應(yīng)的操作,即在A相信號(hào)和B相信號(hào)的一個(gè)周期內(nèi),,有限狀態(tài)機(jī)會(huì)觸發(fā)4次操作,,完成了將信號(hào)進(jìn)行4倍頻的功能,這種方法不僅提高了系統(tǒng)的精度,,還避免了將A相信號(hào)和B相信號(hào)進(jìn)行異或運(yùn)算所帶來的問題,。
2.3 數(shù)據(jù)通信模塊的設(shè)計(jì)
本文采用IP核,將FPGA片內(nèi)RAM資源生成的雙端口RAM作為緩存,,完成FPGA與其他處理芯片的數(shù)據(jù)交換[6],。必要時(shí)可以方便地修改IP核的一些參數(shù),避免了修改硬件給系統(tǒng)帶來的影響,。此外,,利用雙端口RAM作為數(shù)據(jù)通信的緩存,可以有效克服跨時(shí)鐘域數(shù)據(jù)傳輸過程中出現(xiàn)的問題,避免在數(shù)據(jù)傳輸過程中由亞穩(wěn)態(tài)造成的數(shù)據(jù)傳輸錯(cuò)誤,。
在通信過程中,,雙端口RAM分為上下兩個(gè)部分,上半部分為外部芯片數(shù)據(jù)流向FPGA,;下半部分為FPGA數(shù)據(jù)流向外部芯片,,數(shù)據(jù)流向圖如圖5所示。利用一個(gè)同步時(shí)鐘來控制數(shù)據(jù)的傳輸,,在同步時(shí)鐘上升沿,,觸發(fā)FPGA內(nèi)部邏輯模塊和外部芯片分別向雙端口RAM的上下部分同時(shí)寫入數(shù)據(jù);在同步時(shí)鐘的下降沿,,F(xiàn)PGA內(nèi)部的讀寫邏輯模塊和外部芯片分別讀取上下雙端口RAM中的數(shù)據(jù),。利用同步時(shí)鐘控制數(shù)據(jù)的讀寫,能夠防止因外部芯片和內(nèi)部邏輯模塊同時(shí)對(duì)雙端口RAM的同一個(gè)存儲(chǔ)單元進(jìn)行操作所帶來的數(shù)據(jù)沖突,。
3 系統(tǒng)仿真實(shí)現(xiàn)與結(jié)果分析
本設(shè)計(jì)在ISE軟件環(huán)境下進(jìn)行,,使用的芯片為Xilinx公司Spartan-3E系列的XC3S500E,利用Xilinx提供的IP核生成了雙端口RAM,。
采用Verilog HDL語言開發(fā)了濾波模塊和脈沖計(jì)數(shù)模塊,同時(shí)采用Synplify Pro綜合工具進(jìn)行綜合并用Modelsim進(jìn)行仿真驗(yàn)證,。這樣,,系統(tǒng)可以方便地移植到其他器件平臺(tái)上,提高了系統(tǒng)的通用性,。
利用系統(tǒng)經(jīng)過Synplify Pro綜合后的RTL模塊,,可以在不修改模塊間傳輸信號(hào)的情況下,單獨(dú)對(duì)某一模塊的修改不會(huì)造成整個(gè)系統(tǒng)的變動(dòng),,同時(shí)還可以根據(jù)需要,,充分利用FPGA并行處理的特性來擴(kuò)展系統(tǒng)的其他功能。
圖6為濾波模塊利用Modelsim軟件仿真得到的結(jié)果,。其中,,clk為系統(tǒng)工作時(shí)鐘,其經(jīng)過二分頻后得到濾波模塊的采樣時(shí)鐘out_sample,;in_a與in_b為濾波模塊的輸入,,out_a與out_b為模塊輸出。從圖6中可以看到,,輸入信號(hào)in_a的上升沿觸發(fā)了模塊內(nèi)部count_a_p進(jìn)行采樣計(jì)數(shù),。但在一些上升沿處,輸入信號(hào)in_a發(fā)生了抖動(dòng),,高電平時(shí)間沒有持續(xù)6個(gè)采樣時(shí)鐘out_sample周期,,因此抖動(dòng)產(chǎn)生的上升沿?zé)o法引起模塊輸出信號(hào)out_a輸出高電平。只有當(dāng)輸入信號(hào)in_a抖動(dòng)結(jié)束且高電平持續(xù)了6個(gè)采樣周期后,輸出信號(hào)out_a才會(huì)輸出高點(diǎn)平,。同樣,,通過這種采樣計(jì)數(shù)的方式,將輸入信號(hào)in_b的下降沿處的抖動(dòng)濾除,。模塊最終輸出波形out_a及out_b符合正確計(jì)數(shù)的要求,。盡管該方法輸出相對(duì)于輸入有12個(gè)時(shí)鐘周期的延時(shí),但這可以通過適當(dāng)減少電平檢驗(yàn)時(shí)鐘數(shù)來降低,。
圖7和圖8為計(jì)數(shù)模塊的仿真波形圖,。從圖7中可以看到,輸入信號(hào)A,、B電平的改變會(huì)引起計(jì)數(shù)模塊中nstate_reg寄存器和state_reg中的狀態(tài)值改變,,模塊根據(jù)相應(yīng)的邏輯關(guān)系判斷出圓光柵正轉(zhuǎn)并進(jìn)行+1操作。而當(dāng)計(jì)數(shù)模塊累加到設(shè)定的上限值2×106時(shí),,系統(tǒng)將不再增加計(jì)數(shù),,同時(shí)將信號(hào)add_limit置1,起到限位的作用,。由圖8中可以看到,,圓光柵編碼器從正轉(zhuǎn)切換到反轉(zhuǎn),并且反向轉(zhuǎn)動(dòng)速度為正向轉(zhuǎn)動(dòng)的兩倍時(shí)(信號(hào)A和信號(hào)B的頻率增加了一倍),,計(jì)數(shù)模塊可以正確判斷轉(zhuǎn)向并進(jìn)行計(jì)數(shù),。
本文以FPGA為平臺(tái)設(shè)計(jì)了圓光柵編碼器數(shù)據(jù)采集及傳輸一體化系統(tǒng),仿真結(jié)果表明,,該系統(tǒng)能夠有效濾除干擾脈沖,,準(zhǔn)確無誤地進(jìn)行計(jì)數(shù)、辨向及數(shù)據(jù)傳輸,。本文設(shè)計(jì)的數(shù)據(jù)采集系統(tǒng)可以極大地提高系統(tǒng)的集成度和靈活性,,并可以便捷地進(jìn)行功能擴(kuò)展。同時(shí),,利用FPGA內(nèi)部資源完成數(shù)據(jù)在芯片間的傳輸,,保證了系統(tǒng)的穩(wěn)定性和準(zhǔn)確性。該方法可以推廣應(yīng)用到其他領(lǐng)域,。
參考文獻(xiàn)
[1] 阮毅,,陳伯時(shí).電力拖動(dòng)自動(dòng)控制系統(tǒng)[M].北京:機(jī)械工業(yè)出版社,2009.
[2] 覃松,,梁慶.英國雷尼紹RENISHAW圓光柵測量原理及應(yīng)用[J].輕工科技,,2012(4):60,65.
[3] 王誠,,吳繼華,,范麗珍,等.Altera FPGA/CPLD設(shè)計(jì)(基礎(chǔ)篇)[M].北京:人民郵電出版社,2005.
[4] 王彩霞,,李梅.基于FPGA的增量式光電角度編碼器信號(hào)處理系統(tǒng)[J].微計(jì)算機(jī)信息,,2010(23):125-126.
[5] 藍(lán)箭.基于FPGA的光電編碼器干擾消除方法[EB/OL].中國科技論文在線,2010-09-25.
[6] 張偉,,包烏日吐,,閆玉娥.FPGA內(nèi)部塊RAM的應(yīng)用技巧[J].微處理機(jī),2006(6):20-21.