基于光纖陀螺儀的軌道方向不平順檢測(cè)系統(tǒng)
1.引言:
本文引用地址:http://m.butianyuan.cn/article/193530.htm軌道不平順[1]檢測(cè)方法有絕對(duì)測(cè)量與相對(duì)測(cè)量?jī)纱箢悾壳皯?yīng)用廣泛的是相對(duì)測(cè)量法。相對(duì)測(cè)量[2]又分弦測(cè)法、慣性基準(zhǔn)法、慣性元件測(cè)量法等不同方法。其中弦測(cè)法[3]、慣性基準(zhǔn)法使用較多。由于慣性測(cè)量元件成本高昂、體積龐大等原因,慣性元件測(cè)量法一般只局限在大型軌檢車上應(yīng)用。
隨著慣性元件成本的不斷降低及其日漸小型化,該測(cè)量方法在小型軌檢小車上的應(yīng)用正逐步成為可能。其中,光纖陀螺儀[4]作為一種高精度慣性測(cè)量元件,以前主要應(yīng)用于軍事、航空等重要領(lǐng)域,現(xiàn)已廣泛應(yīng)用于民用工業(yè)。
本文詳細(xì)描述了一種由VG951[5]、AD7714、P89V51RD等組成的軌檢小車用軌道方向不平順慣性測(cè)量系統(tǒng)及相關(guān)算法。該慣性測(cè)量系統(tǒng)也可用于軌道高低不平順的測(cè)量。
2.系統(tǒng)要求與技術(shù)關(guān)鍵
慣性法測(cè)量軌向、高低不平順時(shí),實(shí)質(zhì)上是按位置測(cè)量軌道水平方向的擺角或垂直方向的俯仰角。
采用陀螺儀檢測(cè)軌向時(shí),由于軌道在一定長(zhǎng)度上的水平擺角不可能很大,軌檢小車的推行速度又很低,陀螺儀所感受的角速度的值是很小的,其輸出信號(hào)很微弱,很容易被噪聲淹沒。因此,本系統(tǒng)設(shè)計(jì)時(shí),必須從噪聲背景中提取出微弱的角速度信號(hào),并通過積分方法實(shí)現(xiàn)角度信號(hào)的輸出。
陀螺儀零位漂移是影響本系統(tǒng)性能的另一個(gè)關(guān)鍵性問題,也是陀螺儀選型時(shí)必須認(rèn)真考慮的首要因素。
3.系統(tǒng)設(shè)計(jì)
VG951光纖陀螺儀是根據(jù)薩格納克效應(yīng)研制的,即光在薩格納克效應(yīng)中產(chǎn)生的光程差與旋轉(zhuǎn)角速度成正比,從而可通過光的干涉結(jié)果推算角速度,其輸出信號(hào)與角速度成正比。其主要關(guān)鍵技術(shù)指標(biāo)為:偏差穩(wěn)定性:0.3 - 1deg/hr;隨機(jī)游走:0.002deg/sqrtHz;工作范圍:80deg/sec;
偏差重復(fù)性(offset) 1°/hr,1 sigma;偏差變化(恒穩(wěn)態(tài))0.3°/hr,1 sigma;比例因子37mV/°/s±10%;外部磁場(chǎng)1°/hr/Gauss;輸出阻抗1000Ω。由此可以看出,VG951是一種穩(wěn)定性好、漂移小、重復(fù)性好、抗磁能力強(qiáng)的性能優(yōu)異的光纖陀螺儀產(chǎn)品。
陀螺儀用于檢測(cè)軌向時(shí)輸出信號(hào)很微弱,因此,必須選用低噪聲運(yùn)放電路,并合理設(shè)置濾波電路。本系統(tǒng)選用高精度低噪聲的儀用放大器AD620,其最佳源電阻在1000Ω左右,正好與VG951相匹配,能最大限度地減少由于電路阻抗不匹配產(chǎn)生的噪聲[6] 。該放大電路與無源 RC濾波電路組合,能夠有效保證前置放大電路的品質(zhì)。
AD 公司的A/D轉(zhuǎn)換器AD7714[6]是一款帶信號(hào)處理功能的串行A/D,可直接從傳感器接受低電平信號(hào),使用和差轉(zhuǎn)換技術(shù)實(shí)現(xiàn)高達(dá)24bit的無誤碼模數(shù)轉(zhuǎn)換。AD7714內(nèi)置數(shù)字濾波功能,可編程設(shè)置濾波器的截止頻率和穩(wěn)定時(shí)間。本系統(tǒng)可同時(shí)接受和處理二路VG951的輸入。 AD7714參考端電壓(+3.0V)由AD780提供。
陀螺儀信號(hào)是雙極性信號(hào),且信號(hào)地與電源地相通。雖然AD7714可以接受雙極性輸入,但有一個(gè)限制條件,即信號(hào)相對(duì)于AGND的電壓不能低于-30mv。因此,必須將陀螺儀信號(hào)平移一個(gè)基準(zhǔn)電壓(+1.5V),該電壓由AD780分壓提供。
系統(tǒng)以Philips公司的P89V51RD2[8]為控制與數(shù)據(jù)處理中心。P89V51RD2是一種高性能的80C51兼容型單片機(jī),片內(nèi)內(nèi)置64K程序存儲(chǔ)器,768+256Byte數(shù)據(jù)存儲(chǔ)器,可利用 Philips提供的ISP/IAP程序?qū)崿F(xiàn)系統(tǒng)的在線編程(在系統(tǒng)或在應(yīng)用編程)。該CPU管理并控制著數(shù)據(jù)采集過程,由T2 定時(shí)器給AD7714的數(shù)字積分提供精確定時(shí),并完成陀螺儀測(cè)量數(shù)據(jù)的實(shí)時(shí)分析與處理工作。圖1為簡(jiǎn)化硬件原理圖。
同時(shí),P89V51RD2還是與軌檢小車主CPU進(jìn)行數(shù)據(jù)通訊的控制器,成為軌檢小車多CPU主從結(jié)構(gòu)的一個(gè)基礎(chǔ)端點(diǎn)。
圖1 簡(jiǎn)化硬件原理圖
4.零點(diǎn)漸變算法
受陀螺儀零飄以及AD7714 AIN端信號(hào)偏置、基準(zhǔn)電壓和參考電壓穩(wěn)定性等因素的影響,AD7714輸出信號(hào)的零點(diǎn)(陀螺儀角速度為零時(shí)輸出信號(hào))呈現(xiàn)出一定程度的波動(dòng)。如果采用一次平均法計(jì)算零點(diǎn),則隨著時(shí)間變化實(shí)際零點(diǎn)漂移會(huì)很大,既實(shí)際零點(diǎn)與一次平均法所求的零點(diǎn)之差會(huì)變得很大,這樣僅僅零點(diǎn)之差求和(既積分)就會(huì)產(chǎn)生不容忽視漂移。圖2系列3曲線為一次平均法(求取零點(diǎn))所產(chǎn)生的零點(diǎn)積分漂移曲線.
零點(diǎn)漸變算法的基本思路是:用多次平均法代替一次平均法求取零點(diǎn)。首先在陀螺儀靜止不動(dòng)(角速度為零)時(shí),采集八個(gè)數(shù)據(jù)(實(shí)際零點(diǎn))作為樣本,這些樣本叫做零點(diǎn)樣本,求它們的均值,并稱該值為基準(zhǔn)零點(diǎn),第一個(gè)基準(zhǔn)零點(diǎn)叫初始基準(zhǔn)零點(diǎn),然后每采集八個(gè)零點(diǎn)樣本求得一個(gè)新的基準(zhǔn)零點(diǎn)。當(dāng)陀螺儀運(yùn)動(dòng)(角速度不為零)時(shí),零點(diǎn)樣本由上次所求的基準(zhǔn)零點(diǎn)代替,這樣不管陀螺儀狀態(tài)如何,每采集八個(gè)數(shù)據(jù)都可獲得八個(gè)零點(diǎn)樣本,既獲得一個(gè)基準(zhǔn)零點(diǎn),由于實(shí)際零點(diǎn)與基準(zhǔn)零點(diǎn)隨時(shí)間幾乎同時(shí)變化,所以它們之差不會(huì)隨時(shí)間變化而變得很大,這樣零點(diǎn)之差求和(既積分)產(chǎn)生的漂移將大大減少,零點(diǎn)漂移積分效果見圖2系列3曲線。由上所述,求取零點(diǎn)樣本為關(guān)鍵所在,下面是判斷零點(diǎn)(陀螺儀角速度為零)依據(jù)。
由于陀螺儀VG951最小可分辨的角速度為0.002º/s,其比例因子為37mv/(º/s),換算成電壓為37*0.002=74µV,用十六進(jìn)制數(shù)據(jù)表示為74/(3*1000000)/*224=19D,AD采集的數(shù)據(jù)用3字節(jié)數(shù)據(jù)表示:XX XX XX,顯然陀螺儀信號(hào)只能精確到16位。所以信號(hào)采集的精度在16位以上就可以。如果采集的信號(hào)與(初始)基準(zhǔn)零點(diǎn)相減,其差值在100以下,可以認(rèn)為這時(shí)陀螺儀角速度為零,信號(hào)可作為零點(diǎn)樣本。若差值大于100則認(rèn)為是非零信號(hào)(陀螺
儀角速度不為零),該點(diǎn)零點(diǎn)樣本由上次所求的(初始)基準(zhǔn)零點(diǎn)代替。
圖2 陀螺儀靜止不動(dòng)時(shí)零點(diǎn)積分漂移曲線
5.實(shí)驗(yàn)效果
軌道方向(陀螺儀轉(zhuǎn)過的角度)是通過實(shí)際采集的信號(hào)與上次所求的(初始)基準(zhǔn)零點(diǎn)之差求和實(shí)現(xiàn)。實(shí)驗(yàn)輸出曲線見圖 3其中橫坐標(biāo)為秒,縱坐標(biāo)為角度量(未標(biāo)定位為實(shí)際角度),由圖3可知在1小時(shí)內(nèi)角度漂移沒超過400000,化為實(shí)際角度為:400000/16/224*3/0.037=0.06º,漂移非常小。突變曲線是陀螺儀緩慢運(yùn)動(dòng)時(shí)輸出的,反應(yīng)非常靈敏。
圖3 陀螺儀輸出軌向圖
6.結(jié)束語
本文作者創(chuàng)新點(diǎn):該系統(tǒng)采用精密的光纖陀螺儀作為小型軌檢車測(cè)量方向不平順的傳感器,這是一種新的嘗試,并在實(shí)踐中逐步形成了零點(diǎn)漸變算法,此算法是系統(tǒng)成敗的關(guān)鍵。帶有數(shù)字濾波功能的24位A/D AD7714的應(yīng)用提高了抗干擾能力及測(cè)量精度,零點(diǎn)漸變算法、積分功能使得所求角度漂移小精度高,而P89V51RD2提供了更大的數(shù)據(jù)存儲(chǔ)空間,其ISP/IAP功能利于對(duì)系統(tǒng)程序的修改或升級(jí)。
參考文獻(xiàn):
[1]馬小建, 朱洪濤等 .影響軌向不平順的幾個(gè)因數(shù)[J].南昌大學(xué)學(xué)報(bào),2005,1:12-16.
[2]杜鶴亭,長(zhǎng)波長(zhǎng)軌道不平順檢測(cè)中的數(shù)字濾波方法[J].中國(guó)鐵道科學(xué),2000,4:58-64.
[3]朱洪濤, 魏暉等.弦測(cè)法檢測(cè)軌向不平順的研究[J].鐵道建筑,2005,10:63-64 .
[4] 周海波等.光纖陀螺儀的發(fā)展現(xiàn)狀[J].傳感器技術(shù), 2005,6:1-3.
[5]Shanghai Lamshine Co.LTD.VG951 [EB/OL] .
http://www.51sensor.com/english/gyros/VG951.p df
[6]高晉占.微弱信號(hào)檢測(cè)[M].清華大學(xué)出版社,2004,11:53-58.
[7]金旭東,于向軍,呂震.中Σ-Δ數(shù)摸轉(zhuǎn)換在風(fēng)粉測(cè)量中的應(yīng)用[J].微計(jì)算機(jī)信息(測(cè)控儀表自動(dòng)化),2003,9:77-78.
[8]周立功單片機(jī)PHILIPS 80C51系列單片機(jī)應(yīng)用設(shè)計(jì)[EB/OL].
評(píng)論