董登峰，王博，李萬紅，周維虎，勞達寶

(中國科學(xué)院光電研究院，北京100094)

0 引言

激光跟蹤儀是一種高精度超大尺寸空間工業(yè)測量儀器，廣泛應(yīng)用于大型飛機、船舶潛艇、衛(wèi)星火箭、工裝型架等大部件的裝配對接。激光跟蹤儀測量合作目標(biāo)(靶球)的空間坐標(biāo)位置取決于跟蹤儀基準(zhǔn)點到靶球的距離長度及當(dāng)前的方位、俯仰角度，因而角度測量是跟蹤測量的核心單元之一，而且是目前制約空間位置測量精度的主要瓶頸。

為了在激光跟蹤儀中實現(xiàn)精密角度測量，通常采用高精度的角位移測量傳感器圓光柵編碼器，并對編碼器輸出信號進行準(zhǔn)確快速采集。一般而言，角度采集系統(tǒng)有三種方式:采用獨立元器件設(shè)計開發(fā)邏輯門電路，采用專用細分計數(shù)電路，采用現(xiàn)有的可編程邏輯器件或微控制器。第一種方法周期長、可靠性低;第二種方式功能單一、渠道不暢;第三種方式(如FPGA)介于前兩者之間，在保證可靠性的基礎(chǔ)可以方便地進行編程、出錯、再編程操作，靈活性強［1］。

在獲得可靠角度數(shù)據(jù)的基礎(chǔ)上進一步提高測角精度有兩個途徑［2］:①提高光柵盤的刻劃以及軸系的加工、裝配精度;②采用誤差修正技術(shù)。前者受制于加工條件和跟蹤儀的體積大小不易實現(xiàn)，后者主要依賴于光柵盤的檢測精度以及光柵盤本身的重復(fù)精度。所以，以高精度的測量數(shù)據(jù)為基礎(chǔ)，應(yīng)用誤差修正技術(shù)是提高跟蹤儀測角精度的主要途徑之一。

本文針對圓光柵編碼器，介紹一種基于FPGA 的角度采集實現(xiàn)方法以及基于諧波分析的角度誤差修正方法。角度采集充分利用FPGA 大規(guī)模邏輯資源、高集成度、高穩(wěn)定性且易編程的特點，完成對圓光柵輸出信號的濾波、倍頻辨向計數(shù)及數(shù)據(jù)傳輸功能。根據(jù)采集到的角度數(shù)據(jù)，在上位機進行諧波分析，建立誤差修正模型。在測量過程中，根據(jù)模型對實測角度進行在線修正以提高測量精度。

1 系統(tǒng)組成及設(shè)計

為減小儀器體積，激光跟蹤儀中的角度測量采用Renishaw 的精巧型高精度圓光柵。為了消除偏心等誤差，其讀數(shù)頭成對安裝。光柵盤直徑52 mm，全周刻線數(shù)8192，細分盒實現(xiàn)250 倍細分，輸出A，B 正交碼和Index 零位信號，角度分辨力為0.63″。A 信號超前B 信號1/4 周期，表示圓光柵正轉(zhuǎn)，B 信號超前A 信號1/4 周期表示圓光柵反轉(zhuǎn)，如圖1所示。當(dāng)圓光柵經(jīng)過零點時Z 信號輸出一個高電平信號。利用Z 相信號，可以矯正系統(tǒng)的計數(shù)數(shù)據(jù)，有效消除系統(tǒng)的累計誤差。圓光柵通過細分盒處理后，輸出標(biāo)準(zhǔn)的RS422 差分信號，每轉(zhuǎn)產(chǎn)生2048000 個方波脈沖。

圖1 圓光柵正轉(zhuǎn)、反轉(zhuǎn)輸出波形

角度脈沖數(shù)據(jù)采集系統(tǒng)采用自頂向下的設(shè)計思想，除時鐘管理及同步控制外，分為三大模塊［1，3］:數(shù)字濾波、辨向計數(shù)模塊及數(shù)據(jù)通信模塊。其中濾波模塊的主要功能是消除干擾脈沖對系統(tǒng)計數(shù)的影響，保證計數(shù)的準(zhǔn)確性;辨向計數(shù)模塊主要完成四倍頻、正反轉(zhuǎn)辨識和計數(shù)功能;數(shù)據(jù)通信模塊主要負責(zé)將數(shù)據(jù)傳輸?shù)紽PGA 外部其他數(shù)據(jù)處理芯片，避免跨時鐘域數(shù)據(jù)傳輸帶來的各種不利影響。采集系統(tǒng)的結(jié)構(gòu)如圖2所示。

2 角度采集系統(tǒng)設(shè)計

2.1 濾波設(shè)計

跟蹤儀在工業(yè)現(xiàn)場應(yīng)用存在各種不確定性因素，如跟蹤控制過程中跟蹤頭的振動、抖動和現(xiàn)場環(huán)境中的電磁干擾。干擾噪聲會使得圓光柵細分盒輸出的正交編碼信號在一定程度上受到干擾，輸出脈沖產(chǎn)生毛刺，導(dǎo)致脈沖計數(shù)錯誤，從而嚴重影響測量精度［4］。

圖2 角度數(shù)據(jù)采集系統(tǒng)結(jié)構(gòu)框圖

由于經(jīng)過細分盒輸出的方波脈沖為差分信號，受到電磁干擾產(chǎn)生的共模噪聲在一定程度上得到抑制。對于機械振動和抖動產(chǎn)生的噪聲，通常表現(xiàn)為在某一相的脈沖的邊緣地方出現(xiàn)毛刺的情況，如圖3所示。因此有效濾除脈沖的抖動和毛刺，是提高計數(shù)精度的關(guān)鍵步驟。

對抖動產(chǎn)生的毛刺信號進行觀察和分析發(fā)現(xiàn)，其持續(xù)時間通常極短，故頻率一般都遠高于圓光柵正常工作時所輸出的脈沖頻率，因此本文采用一種高頻數(shù)字計數(shù)濾波方法:根據(jù)系統(tǒng)允許的最高轉(zhuǎn)速，結(jié)合所使用圓光柵的刻線數(shù)，計算出最高轉(zhuǎn)速下圓光柵輸出的脈沖頻率，并以此頻率為臨界點，將高于這個臨界點的脈沖視為干擾脈沖濾除。即只有持續(xù)時間超過允許的最短時間的脈沖視為正常的計數(shù)脈沖。

圖3 受干擾后編碼器輸出波形

激光跟蹤儀允許的電機最大轉(zhuǎn)速為15 r/min，有效脈沖最高頻率應(yīng)為500 kHz。FPGA 工作時鐘設(shè)定為50 MHz，則1/4 周期光柵脈沖信號的高或者低電平至少應(yīng)持續(xù)12 個FPGA 工作時鐘。持續(xù)時間低于12 個工作時鐘的脈沖信號(超過了激光跟蹤儀允許的最大轉(zhuǎn)速)被視為干擾脈沖予以濾除。持續(xù)時間大于等于12個工作時鐘的脈沖將被送到FPGA 的辨向計數(shù)單元。此方法能有效去除高頻脈沖干擾對計數(shù)的影響，保證系統(tǒng)的測量精度。

2.2 辨向計數(shù)

激光跟蹤儀一個顯著的特點是實時精密跟蹤合作目標(biāo)，因此跟蹤頭旋轉(zhuǎn)方向在不斷改變。為準(zhǔn)確地進行跟蹤角度測量，角度采集系統(tǒng)必須具有快速準(zhǔn)確的辨向計數(shù)功能。

根據(jù)Renishaw 增量式圓光柵編碼器的基本工作原理，A，B 兩相信號輸出共產(chǎn)生4 個跳變沿，基于A 相和B 相信號的跳變沿對圓光柵狀態(tài)進行劃分。根據(jù)狀態(tài)劃分和時序，本文采用有限狀態(tài)機對圓光柵的方波信號進行四倍頻辨向計數(shù)，另外狀態(tài)機專設(shè)一路高速同步時鐘對方波信號進行采樣和濾波處理。

有限狀態(tài)機是一種根據(jù)輸入集合及次序決定輸出集合的時序電路，是數(shù)字系統(tǒng)中實現(xiàn)高效率可靠性邏輯控制的重要方法。其可分為Moore 和Mealy 兩種類型。Mealy 狀態(tài)機的輸出是當(dāng)前狀態(tài)和輸入信號的函數(shù)。即當(dāng)前的圓光柵計數(shù)器既與當(dāng)前編碼器所處的組合狀態(tài)有關(guān)，又與前一個狀態(tài)有關(guān)。Mealy 狀態(tài)機具有較強的實時性，用于防止輸出信號出現(xiàn)毛刺，增強系統(tǒng)的穩(wěn)定性，而且比Moore 狀態(tài)機在狀態(tài)切換時提前一個同步時鐘。

將圓光柵輸出信號A，B 的高低電平分別用1，0 表示，則兩者組合共有A1B1，A1B0，A0B1，A0B0 四種穩(wěn)定狀態(tài)。當(dāng)圓光柵輸出狀態(tài)按A0B0→A1B0→A1B1→A0B1→A0B0 變化時，表示圓光柵正轉(zhuǎn)，狀態(tài)機計數(shù)增加;當(dāng)狀態(tài)按A0B0→A0B1→A1B1→A1B0→A0B0 變化時，圓光柵反轉(zhuǎn)，狀態(tài)機計數(shù)遞減。圓光柵一旦轉(zhuǎn)動，計數(shù)模塊可以隨時在正轉(zhuǎn)和反轉(zhuǎn)狀態(tài)中自由切換。

辨向計數(shù)模塊內(nèi)部自定義兩個寄存器分別存儲“當(dāng)前狀態(tài)”和“新狀態(tài)”?！爱?dāng)前狀態(tài)”和“新狀態(tài)”值相同時，則狀態(tài)機等待且不進行任何操作。當(dāng)圓光柵編碼器輸出信號A 或B 任一電平信號發(fā)生變化時，辨向計數(shù)模塊會將其存儲到“新狀態(tài)”寄存器中，并根據(jù)A，B 兩相信號相應(yīng)的邏輯關(guān)系及兩個寄存器中的狀態(tài)判斷當(dāng)前的狀態(tài)變化所表征的編碼器轉(zhuǎn)動方向，同時進行相應(yīng)的加或減運算。接著將“新狀態(tài)”寄存器中的值賦給“當(dāng)前狀態(tài)”寄存器，等待A 或B 信號的改變觸發(fā)下新一輪的操作。如此反復(fù)完成轉(zhuǎn)向辨識和脈沖計數(shù)。

由于穩(wěn)定狀態(tài)是以A 相信號和B 相信號的脈沖邊沿變化進行劃分的，而A，B 一個周期內(nèi)邊沿均變化兩次，所以有限狀態(tài)機在一個周期內(nèi)會觸發(fā)4 次狀態(tài)判斷，完成了信號的四倍頻的功能，提高了脈沖計數(shù)的分辨力。

為了便于軟件維護及升級，程序設(shè)計中引入A0B0+，A1B0 +，A1B1 +，A0B1 + 與A0B0-，A1B0-，A1B1-，A0B1-等八個狀態(tài)，用于表示A 相信號和B相信號在某個特定的狀態(tài)下發(fā)生變化后，所引起的有限狀態(tài)機的操作。狀態(tài)機狀態(tài)的轉(zhuǎn)換流程圖如圖4所示。

圖4 辨向計數(shù)模塊狀態(tài)機狀態(tài)轉(zhuǎn)換圖

2.3 數(shù)據(jù)通信模塊的設(shè)計

角度數(shù)據(jù)采集系統(tǒng)需要與跟蹤儀的跟蹤控制單元進行實時通信，以提供角度信息并進行誤差補償和進一步數(shù)據(jù)處理。為此本文利用FPGA 片內(nèi)資源自定義一片雙口RAM 作為緩存。片內(nèi)一部分用來存儲外部處理器發(fā)送到FPGA 的指令，另一部分用來存儲FPGA 上傳至上位機或其外部處理器的計數(shù)結(jié)果。自定義雙口RAM 能夠靈活地配置地址總線、總線數(shù)據(jù)寬度，修改與通信相關(guān)的邏輯次序和協(xié)議，方便地擴展FPGA 數(shù)據(jù)采集系統(tǒng)的其他功能。為便于與其他處理器進行通信，RAM 區(qū)預(yù)留一個同步時鐘信號，進行同步通訊。以避免數(shù)據(jù)傳輸過程中由亞穩(wěn)態(tài)造成的錯誤。自定義雙口RAM 的數(shù)據(jù)流向如圖5所示。

圖5 自定義雙口RAM 數(shù)據(jù)流向

在通信過程中，把自定義的雙口RAM 劃分為命令、數(shù)據(jù)兩個部分，命令部分為外部處理器數(shù)據(jù)流向FPGA;數(shù)據(jù)部分為FPGA 計數(shù)邏輯模塊向雙口RAM 的數(shù)據(jù)部分寫入數(shù)據(jù);在同步時鐘的下降沿“片選”以及“讀”信號有效后，觸發(fā)FPGA 數(shù)據(jù)流向外部處理器。利用預(yù)留的同步時鐘來控制數(shù)據(jù)的傳輸:在同步時鐘上升沿“片選”信號以及“寫”信號有效后，觸發(fā)FPGA 內(nèi)部邏輯電路，內(nèi)部的邏輯模塊和外部處理器分別讀取雙口RAM 中的數(shù)據(jù)。利用同步時鐘控制數(shù)據(jù)的讀寫，能夠防止外部處理器和內(nèi)部邏輯模塊同時對雙口RAM 的同一個存儲單元進行操作所產(chǎn)生的數(shù)據(jù)沖突。而且由于同步時鐘的控制，F(xiàn)PGA 傳輸?shù)臄?shù)據(jù)僅延遲了一個同步時鐘周期，較好地保證了激光跟蹤儀控制系統(tǒng)的實時性。在此基礎(chǔ)上，如果想進一步提高實時性可以根據(jù)實際的通訊速度和頻率，適當(dāng)調(diào)整同步時鐘的周期。

3 仿真及實驗結(jié)果

基于前述設(shè)計思路，本文以Xilinx 公司Spartan-3E系列的FPGA XC3S500E 作為驗證平臺。在ISE 軟件環(huán)境下，基于Verilog HDL 語言開發(fā)各個功能模塊，利用Modelsim 進行仿真。結(jié)果如圖6 和圖7所示。

圖6 濾波模塊仿真波形圖

圖7 辨向計數(shù)模塊仿真結(jié)果圖

圖6 中clk 為系統(tǒng)工作時鐘，in_a 與in_b 為數(shù)字濾波模塊的輸入，out_sample 為clk 二倍頻后得到的采樣時鐘，out_a 與out_b 為模塊輸出。由圖6 可以看到系統(tǒng)輸入in_a 和in_b 經(jīng)過濾波模塊處理后，高頻干擾脈沖被有效濾除，數(shù)字濾波模塊輸出波形out_a及out_b 符合正確計數(shù)的要求。

由圖7，輸入信號a，b 電平的改變會引起計數(shù)模塊中狀態(tài)寄存器“新狀態(tài)”nstate_reg 和“當(dāng)前狀態(tài)”state_reg 狀態(tài)值的改變，計數(shù)模塊根據(jù)有限狀態(tài)機辨識出圓光柵為正轉(zhuǎn)或反轉(zhuǎn)并進行+1 或-1 操作。由仿真結(jié)果可以看出當(dāng)圓光柵編碼器從正轉(zhuǎn)切換到反轉(zhuǎn)，并且反向轉(zhuǎn)動速度為正向轉(zhuǎn)速的2 倍時(信號A 和信號B 的頻率增加了一倍)，計數(shù)模塊可以正確辨向并計數(shù)。

在仿真驗證的基礎(chǔ)上，以8 面棱體與自準(zhǔn)直儀相結(jié)合開展實驗進行角度驗證。實測8 組角度數(shù)據(jù)及其相應(yīng)的測量偏差如表1所示。

Renishaw 圓光柵的技術(shù)手冊標(biāo)明光柵測量誤差為4.28″，實驗測得的角度誤差小于3.5″，表明角度采集處理結(jié)果準(zhǔn)確無誤，能夠滿足激光跟蹤儀的角度測量要求。

4 誤差分析及修正

激光跟蹤儀測角誤差主要來源于光柵盤的機械安裝誤差、柱面刻劃誤差以及細分盒的細分誤差等周期性誤差［5-6］。機械安裝誤差包括偏心、傾斜、軸系晃動等;刻劃誤差指刻線實際位置與理想位置的偏差;細分誤差指細分信號的非嚴格正交誤差、幅度不等誤差和電壓信號的漂移誤差。前兩者以一轉(zhuǎn)為一個基周期，屬于中低頻誤差;后者以一個柵距為一個基周期，屬于高頻誤差。但兩者都具有周期性，因而可以采用諧波分析法對誤差數(shù)據(jù)進行處理以提高測量精度，即在基周期內(nèi)取N 等分測量點，將離散實驗數(shù)據(jù)近似表示為傅里葉級數(shù)，通過數(shù)據(jù)擬合計算得到各階諧波系數(shù)。當(dāng)?shù)确謹?shù)N 為偶數(shù)時，只能計算到m=N /2 階系數(shù);N 為奇數(shù)時，只能計算到m=(N- 1)/2 階系數(shù)［6-7］。

表1 實驗測試結(jié)果

一般地，對于0 ～m 階誤差諧波函數(shù)，可以表示為

式中:m 為測角誤差諧波的最高階數(shù)，Ck為第k 階誤差諧波系數(shù)，φk為第k 階諧波誤差的初相角。

實驗測得的誤差以Δθ 表示，則可以采用非線性最小二乘法求解下式［8］，即

得到滿足e 為最小值時的諧波系數(shù)Ck，φk。由于采用的是8 面棱體，所以m=4，根據(jù)表1 及式(2)，得到計算結(jié)果如表2所示。

表2 誤差諧波函數(shù)參量計算結(jié)果

由表2，諧波函數(shù)的一、二、三階系數(shù)較大，權(quán)重較高，所以采用一、二、三階諧波函數(shù)對測量誤差進行修正。重新開展一次實驗，實測誤差及修正后的結(jié)果如表3所示。

表3 誤差修正前后的結(jié)果對比

實驗數(shù)據(jù)表明，測量誤差由3.5″減小到1.5″以內(nèi)，這說明誤差諧波分析方法能夠顯著提高圓光柵測角系統(tǒng)的精度。

5 結(jié)束語

本文以FPGA 為平臺，詳細介紹了激光跟蹤儀角度數(shù)據(jù)采集系統(tǒng)的設(shè)計和實現(xiàn)方法，仿真及實驗結(jié)果表明該系統(tǒng)能夠有效濾除干擾脈沖，準(zhǔn)確無誤地進行辨向計數(shù)及數(shù)據(jù)通信。在分析了圓光柵測角誤差產(chǎn)生機理的基礎(chǔ)上，采用誤差諧波分析方法對實驗結(jié)果進行誤差修正，使系統(tǒng)測量誤差由3.5″減小到1.5″以內(nèi)。本文設(shè)計的角度采集系統(tǒng)具有靈活性和易于擴展的特點，所采用的諧波分析方法具有一定的通用性，可以綜合推廣應(yīng)用到其他相關(guān)領(lǐng)域。

［1］王博，郭陽寬，周維虎，等.基于FPGA 的圓光柵編碼器數(shù)據(jù)采集系統(tǒng)設(shè)計［J］.微型機與應(yīng)用，2012，31(23):28-31.

［2］費斌，徐文雄，蔣莊德，等.計量圓光柵動態(tài)精度的檢測技術(shù)［J］.儀器儀表學(xué)報，1996，17(5):525-529.

［3］王鵬，杜衛(wèi)東，呂志剛，等.基于FPGA 與FSM 的高精度測角系統(tǒng)設(shè)計與實現(xiàn)［J］.測控技術(shù)與儀器儀表，2012，38(2):77-79，83.

［4］蘇東風(fēng)，續(xù)志軍，賈繼強，等.提高圓光柵測角系統(tǒng)精度的讀數(shù)頭設(shè)計［J］.電子測量與儀器學(xué)報，2013，27(7):653-657.

［5］高貫斌.圓光柵角度傳感器的誤差補償及參數(shù)辨識［J］.光學(xué)精密工程，2010，18(8):1766-1762.

［6］趙人杰，馬文禮.利用誤差諧波補償法提高金屬圓光柵測角精度［J］.儀器儀表用戶.2009，116(3):69-71.

［7］Kaul S K，Tickoo A K，Koul R，et al，Improving the accuracy of low-cost resolver-based encoders using harmonicanalysis［J］.Nuclear Instruments and Methodsin Physics Research，2008，586(A):345-355.

［8］張禮松，管炳良.關(guān)節(jié)坐標(biāo)測量機研制中圓光柵誤差修正技術(shù)［J］.計測技術(shù)，2007，27(4):41-43.