本發(fā)明涉及微電子
技術(shù)領(lǐng)域:
,特別是涉及一種提高陀螺儀測(cè)量精度的方法。
背景技術(shù):
:MEMS(Micro-Electro-MechanicalSystem,微機(jī)電系統(tǒng))陀螺儀具有體積小、質(zhì)量輕、功耗低和成本低等優(yōu)點(diǎn),已被廣泛利用于導(dǎo)航與制導(dǎo)
技術(shù)領(lǐng)域:
。由于陀螺儀的核心敏感元件及其處理電路很容易受到外界因素的影響,例如溫度、電磁、震動(dòng)、重力、濕度、氣壓等外界因素都可能會(huì)影響陀螺儀敏感元件和處理電路的特性,從而影響陀螺儀輸出精度,因此需要借助外界設(shè)備對(duì)其測(cè)量結(jié)果進(jìn)行標(biāo)定?,F(xiàn)有的標(biāo)定技術(shù),主要是通過(guò)轉(zhuǎn)臺(tái)、溫箱進(jìn)行速率標(biāo)定和溫度標(biāo)定,通過(guò)標(biāo)定得到陀螺儀受溫度影響零位、零偏的變化、標(biāo)度因素和安裝誤差等。現(xiàn)有的陀螺標(biāo)定因數(shù)的求解方式如下:設(shè)為第j個(gè)輸入角速度時(shí)陀螺儀輸出的平均值,標(biāo)度因數(shù)計(jì)算方法如公式(1)、(2)和(3)所示:Fj‾=1NΣn=1NFjn---(1)]]>F‾r=12(Fs‾+Fe‾)---(2)]]>Fj=Fj‾-F‾r---(3)]]>其中,F(xiàn)j為陀螺儀的輸出角度,F(xiàn)jn為陀螺儀第N個(gè)輸出值,為測(cè)試開始陀螺儀輸出的平均值,為測(cè)試結(jié)束時(shí)陀螺儀輸出的平均值,為測(cè)試中陀螺儀輸出的平均值。建立陀螺儀輸入輸出關(guān)系的線性模型,如公式(4)所示:Fj=K·Ωij+F0+vj(4)其中,F(xiàn)j是陀螺的輸出角度,K為陀螺儀的標(biāo)度因數(shù),Ωij為第j個(gè)輸入 角速度,F(xiàn)0為擬合零位,單位為度每小時(shí)(°/h),vj是陀螺儀測(cè)量噪聲。用最小二乘法求陀螺儀的標(biāo)度因數(shù)K和擬合零位F0:K=Σj=1MΩij·Fj-1MΣj=1MΩij.Σj=1MFjΣj=1MΩ2ij-1M(Σj=1MΩij)2---(5)]]>F0=1MΣj=1MFj-KMΣj=1MΩij---(6)]]>由于陀螺儀的標(biāo)度因素、零偏、零偏穩(wěn)定性等受溫度,濕度等環(huán)境的影響,每次測(cè)量值都不相同或有細(xì)微的變化,因此一次標(biāo)定并不能夠準(zhǔn)確測(cè)量陀螺的零偏、標(biāo)度因數(shù)等參數(shù),在實(shí)際使用時(shí)必然會(huì)帶來(lái)一定的誤差??傊枰绢I(lǐng)域技術(shù)人員迫切解決的一個(gè)技術(shù)問(wèn)題就是:如何提高陀螺儀的測(cè)量精度。技術(shù)實(shí)現(xiàn)要素:本發(fā)明提供了一種基于差分MEMS陀螺儀的高精度測(cè)量方法,以解決陀螺儀測(cè)量精度不高的技術(shù)問(wèn)題。本發(fā)明實(shí)施例提供了一種基于差分MEMS陀螺儀的高精度測(cè)量方法,包括:選取陀螺儀構(gòu)建至少兩個(gè)差分對(duì),所述差分對(duì)中包括一個(gè)正向陀螺儀和一個(gè)反向陀螺儀,所述正向陀螺儀和所述反向陀螺儀分別置于同一轉(zhuǎn)臺(tái)敏感軸的正側(cè)和反側(cè),使所述正向陀螺儀和所述反向陀螺儀以相同角速率分別正向旋轉(zhuǎn)和反向旋轉(zhuǎn),使外部信號(hào)對(duì)所述正向陀螺儀和所述反向陀螺儀表現(xiàn)為共模差分信號(hào);采集正向陀螺儀的各階系數(shù)和反向陀螺儀的各階系數(shù);依據(jù)所述正向陀螺儀的各階系數(shù)和反向陀螺儀的各階系數(shù),計(jì)算各階擬合系數(shù);依據(jù)各個(gè)所述各階擬合系數(shù),計(jì)算各個(gè)所述各階擬合系數(shù)的平均數(shù);依據(jù)所述平均數(shù),計(jì)算各階擬合系數(shù)方差;選取所述各階擬合系數(shù)方差最小的差分對(duì),測(cè)量輸入角速度。優(yōu)選地,所述測(cè)量輸入角速度w的過(guò)程如下所示:w=(Gp-Σi=1nKpwi·Wpi)-(Kbd·Gn-Σi=1nKbd·Knwi·Wni)Kp+Kbd·Kn-Nc]]>其中,Nc為高斯白噪聲,Kbd為正向陀螺和反向陀螺儀的環(huán)境系數(shù)比值,Kp為正向陀螺儀的標(biāo)定因數(shù),Kn為反向陀螺儀的標(biāo)定因數(shù),Gp為正向陀螺儀的輸出值,Gn為反向陀螺儀的輸出值,Kpwi為正向陀螺儀第i個(gè)采樣點(diǎn)的確定性誤差項(xiàng)系數(shù),Kpwi表示負(fù)向陀螺儀第i個(gè)采樣點(diǎn)的確定性誤差項(xiàng)系數(shù),Wpi表示正向陀螺儀測(cè)試時(shí)刻第i個(gè)確定性誤差項(xiàng),Wni表示負(fù)向陀螺儀測(cè)試時(shí)刻第i個(gè)確定性誤差項(xiàng),i=1,...n,n=2~7。優(yōu)選地,所述高斯白噪聲Nc的計(jì)算過(guò)程如下所示:Nc=N1-Kbd·N2Kp+Kbd·Kn]]>其中,N1為正向陀螺儀測(cè)試時(shí)的測(cè)量噪聲,N2為負(fù)向陀螺儀測(cè)試時(shí)的測(cè)量噪聲。優(yōu)選地,所述為正向陀螺和反向陀螺儀的環(huán)境系數(shù)比值Kbd的計(jì)算過(guò)程如下所示:Kbd=1mΣj=1m(Gpj-Σi=1nKpwi·Wpi-Kp·w)1mΣj=1m(Gnj-Σi=1nKnwi·Wni-Kn·w)]]>其中,j表示每次參與數(shù)據(jù)平滑處理的數(shù)據(jù)個(gè)數(shù),j=1,...m,m=8~30,Gpj表示正向陀螺儀第j個(gè)采樣點(diǎn)的輸出值,Gnj表示負(fù)向陀螺儀第j個(gè)采樣點(diǎn)的輸出值,w為測(cè)試時(shí)刻的輸入角速度。優(yōu)選地,所述選取陀螺儀構(gòu)建至少兩個(gè)差分對(duì)包括:從相同批次、相同工藝和相同量程的陀螺儀中選取陀螺儀構(gòu)建至少兩個(gè)差分對(duì)。優(yōu)選地,所述依據(jù)所述正向陀螺儀的各階系數(shù)和反向陀螺儀的各階系數(shù),計(jì)算各階擬合系數(shù)包括:將所述正向陀螺儀的各階系數(shù)和反向陀螺儀的各階系數(shù)做商,獲得所述各階擬合系數(shù)。與現(xiàn)有技術(shù)相比,本發(fā)明具有以下優(yōu)點(diǎn):選取各階擬合系數(shù)方差最小的 差分對(duì),提高了組成差分陀螺對(duì)的兩個(gè)陀螺儀的相似性,這就把目前難度很大的通過(guò)改善陀螺儀加工工藝的方法來(lái)提高陀螺儀精度的問(wèn)題,轉(zhuǎn)化為了難度不大的通過(guò)提高兩個(gè)陀螺儀相似性的方法來(lái)提高陀螺儀精度,提高了陀螺儀的精度。附圖說(shuō)明為了更清楚地說(shuō)明本發(fā)明實(shí)施例或現(xiàn)有技術(shù)中的技術(shù)方案,下面將對(duì)實(shí)施例或現(xiàn)有技術(shù)描述中所需要使用的附圖作簡(jiǎn)單地介紹,顯而易見(jiàn)地,下面描述中的附圖僅僅是本發(fā)明的一些實(shí)施例,對(duì)于本領(lǐng)域普通技術(shù)人員來(lái)講,在不付出創(chuàng)造性勞動(dòng)的前提下,還可以根據(jù)這些附圖獲得其他的附圖。圖1是本發(fā)明實(shí)施例提供的一種提高陀螺儀測(cè)量精度的方法的流程示意圖;圖2是本發(fā)明實(shí)施例提供的陀螺儀測(cè)量角速度裝置的結(jié)構(gòu)示意圖。具體實(shí)施方式下面將結(jié)合本發(fā)明實(shí)施例中的附圖,對(duì)本發(fā)明實(shí)施例中的技術(shù)方案進(jìn)行清楚、完整地描述,顯然,所描述的實(shí)施例僅僅是本發(fā)明一部分實(shí)施例,而不是全部的實(shí)施例?;诒景l(fā)明中的實(shí)施例,本領(lǐng)域普通技術(shù)人員在沒(méi)有做出創(chuàng)造性勞動(dòng)前提下所獲得的所有其他實(shí)施例,都屬于本發(fā)明保護(hù)的范圍。實(shí)施例一本發(fā)明實(shí)施例提供了一種基于差分MEMS(Micro-Electro-MechanicalSystem,微機(jī)電系統(tǒng))陀螺儀的高精度測(cè)量方法,以解決陀螺儀測(cè)量精度不高的問(wèn)題,本發(fā)明實(shí)施例提供的基于差分MEMS陀螺儀的高精度測(cè)量方法包括以下步驟:S101,選取陀螺儀構(gòu)建至少兩個(gè)差分對(duì),差分對(duì)中包括一個(gè)正向陀螺儀和一個(gè)反向陀螺儀,正向陀螺儀和反向陀螺儀分別置于同一轉(zhuǎn)臺(tái)敏感軸的正側(cè)和反側(cè),使正向陀螺儀和反向陀螺儀以相同角速率分別正向旋轉(zhuǎn)和反向旋轉(zhuǎn),使外部信號(hào)對(duì)正向陀螺儀和反向陀螺儀表現(xiàn)為共模差分信號(hào)。在本步驟中,可以從相同批次、相同工藝和相同量程的陀螺儀中選取陀螺儀構(gòu)建至少兩個(gè)個(gè)差分對(duì),每個(gè)差分對(duì)中包括兩個(gè)陀螺儀。例如,從100個(gè)相同批次、相同工藝和相同量程的陀螺儀中選取20個(gè)陀螺儀構(gòu)建10個(gè)差分對(duì),每個(gè)差分對(duì)中包括兩個(gè)陀螺儀。由于相同批次、相同工藝和相同量程的陀螺儀的環(huán)境敏感特性比較相似,這樣就滿足了建立差分對(duì)的要求??梢詫⒉罘謱?duì)中的兩個(gè)陀螺儀分別設(shè)置于同一轉(zhuǎn)臺(tái)的正側(cè)和反側(cè),使兩個(gè)陀螺儀以相同角速度分別正向旋轉(zhuǎn)和反向旋轉(zhuǎn)。一般來(lái)說(shuō),轉(zhuǎn)臺(tái)臺(tái)面向上的方向?yàn)檎齻?cè),轉(zhuǎn)臺(tái)臺(tái)面向下的方向?yàn)榉磦?cè);設(shè)置于轉(zhuǎn)臺(tái)正側(cè)的陀螺儀可以稱為正向陀螺儀,設(shè)置于轉(zhuǎn)臺(tái)反側(cè)的陀螺儀可以稱為反向陀螺儀。S102,采集正向陀螺儀的各階系數(shù)和反向陀螺儀的各階系數(shù),依據(jù)正向陀螺儀的各階系數(shù)和反向陀螺儀的各階系數(shù),計(jì)算各階擬合系數(shù)。在本步驟中,可以將正向陀螺儀的各階系數(shù)和反向陀螺儀的各階系數(shù)做商,獲得各階擬合系數(shù)。各階擬合系數(shù)可以包括陀螺儀的標(biāo)度因數(shù)、溫度漂移系數(shù)和安裝誤差系數(shù)。步驟S103,依據(jù)各個(gè)各階擬合系數(shù),計(jì)算各個(gè)各階擬合系數(shù)的平均數(shù)。在本步驟中,可以將各個(gè)各階擬合系數(shù)進(jìn)行累加,再除以各階擬合系數(shù)的數(shù)量,以獲得各個(gè)各階擬合系數(shù)的平均數(shù)。例如,差分對(duì)1的各階擬合系數(shù)為0.7,差分對(duì)2的各階擬合系數(shù)為1,差分對(duì)3的各階擬合系數(shù)為1.1,則各個(gè)各階擬合系數(shù)的平均數(shù)為0.93。步驟S104,依據(jù)平均數(shù),計(jì)算各階擬合系數(shù)方差。在本步驟中,可以依據(jù)(xi-M)2計(jì)算各階擬合系數(shù)方差,其中xi為差分對(duì)i的個(gè)階擬合系數(shù),i為大于等于2的正整數(shù),M為各個(gè)差分對(duì)的各階擬合系數(shù)平均值。例如,差分對(duì)1的各階擬合系數(shù)為0.7,差分對(duì)2的各階擬合系數(shù)為1,差分對(duì)3的各階擬合系數(shù)為1.1,則各個(gè)各階擬合系數(shù)的平均數(shù)為0.93。則差分對(duì)1的各階擬合系數(shù)方差為0.0529,差分對(duì)2的各階擬合系數(shù)方 差為0.0049,差分對(duì)2的各階擬合系數(shù)方差為0.0729。S105,選取各階擬合系數(shù)方差最小的差分對(duì),測(cè)量輸入角速度。在本步驟中,各階擬合系數(shù)方差越小的差分對(duì)中的兩個(gè)陀螺儀的相似性最為接近。測(cè)量輸入角速度w的過(guò)程如下所示:w=(Gp-Σi=1nKpwi·Wpi)-(Kbd·Gn-Σi=1nKbd·Knwi·Wni)Kp+Kbd·Kn-Nc]]>其中,Nc為高斯白噪聲,Kbd為正向陀螺和反向陀螺儀的環(huán)境系數(shù)比值,Kp為正向陀螺儀的標(biāo)定因數(shù),Kn為反向陀螺儀的標(biāo)定因數(shù),Gp為正向陀螺儀的輸出值,Gn為反向陀螺儀的輸出值,Kpwi為正向陀螺儀第i個(gè)采樣點(diǎn)的確定性誤差項(xiàng)系數(shù),Knwi表示負(fù)向陀螺儀第i個(gè)采樣點(diǎn)的確定性誤差項(xiàng)系數(shù),Wpi表示正向陀螺儀測(cè)試時(shí)刻第i個(gè)確定性誤差項(xiàng),Wni表示負(fù)向陀螺儀測(cè)試時(shí)刻第i個(gè)確定性誤差項(xiàng),i=1,...n,n=2~7。通過(guò)本發(fā)明實(shí)施例提供的一種基于差分MEMS陀螺儀的高精度測(cè)量方法,選取各階擬合系數(shù)方差最小的差分對(duì),提高了組成差分陀螺對(duì)的兩個(gè)陀螺儀的相似性,這就把目前難度很大的通過(guò)改善陀螺儀加工工藝的方法來(lái)提高陀螺儀精度的問(wèn)題,轉(zhuǎn)化為了難度不大的通過(guò)提高兩個(gè)陀螺儀相似性的方法來(lái)提高陀螺儀的問(wèn)題,提高了陀螺儀的精度。為進(jìn)一步提高測(cè)量角速度的精度,可以將不同量程的陀螺儀混合使用測(cè)量角速度,例如,轉(zhuǎn)速較高時(shí),可以使用大量程的陀螺儀測(cè)量角速度;轉(zhuǎn)速較低時(shí),可以使用小量程的陀螺儀測(cè)量角速度。通過(guò)對(duì)載體角速度的判斷,在不同量程的陀螺之間進(jìn)行切換,兼顧陀螺測(cè)量精度和范圍的問(wèn)題,減少了小量程陀螺在使用過(guò)程中經(jīng)常會(huì)遇見(jiàn)的過(guò)載情況,提高陀螺的抗過(guò)載能力。實(shí)施例二本發(fā)明實(shí)施例二提供了測(cè)量輸入角速度w的具體推導(dǎo)過(guò)程。根據(jù)陀螺儀的工作原理和測(cè)試原理,可得出陀螺儀的輸出值G與輸入角速度ω之間的關(guān)系式,將輸出值G和可以測(cè)試、標(biāo)定和補(bǔ)償?shù)膎個(gè)確定性誤差項(xiàng)放在等式的左邊,將未知的輸入角速度ω和難以測(cè)試、標(biāo)定、補(bǔ)償?shù)牟? 確定性誤差項(xiàng)和噪聲項(xiàng)放在等式的右邊,則陀螺儀的輸出值G與輸入角速度ω之間的關(guān)系式如公式(7)所示:G-Σi=1nKwi·Wi=K·w+Kd·D+N---(7)]]>其中,G為陀螺儀的輸出值,Kwi是第i個(gè)確定性誤差項(xiàng)系數(shù),i=1,...,n;Wi是第i個(gè)確定性誤差項(xiàng),i=1,...,n,n=2~7,K為陀螺儀的標(biāo)度因數(shù),Kd是不確定性總誤差系數(shù);D測(cè)試時(shí)刻的不確定誤差量的總和;N為測(cè)量噪聲。如圖2所示,當(dāng)沿著被測(cè)轉(zhuǎn)動(dòng)軸Z有一個(gè)輸入角速度w時(shí),則正向陀螺儀1的敏感軸OA1測(cè)量到的輸入角速度為+w,而負(fù)向陀螺儀2的敏感軸OA2測(cè)量到的輸入角速度為-w。為了區(qū)別兩個(gè)陀螺儀的參數(shù),可以給正向陀螺儀參數(shù)標(biāo)注下標(biāo)p,給負(fù)向陀螺儀參數(shù)標(biāo)注下標(biāo)n。則根據(jù)公式(7)得出正向陀螺儀的輸入輸出關(guān)系如公式(8)所示:Gp-Σi=1nKpwi·Wpi=Kp·w+KpdD1+N1---(8)]]>其中,Gp為正向陀螺儀的輸出值,Kpwi為正向陀螺儀第i個(gè)采樣點(diǎn)的確定性誤差項(xiàng)系數(shù),Wpi表示正向陀螺儀測(cè)試時(shí)刻第i個(gè)確定性誤差項(xiàng),,i=1,...n,n=2~7,N1為正向陀螺儀測(cè)試時(shí)的測(cè)量噪聲,D1為正向陀螺儀不確定性誤差總量,Kpd為正向陀螺儀環(huán)境系數(shù)。根據(jù)公式(7)得負(fù)向陀螺儀的輸入輸出關(guān)系如公式(9)所示:Gn-Σi=1nKnwi·Wni=Kn·(-w)+KndD2+N2---(9)]]>其中,Gn為反向陀螺儀的輸出值,Knwi表示負(fù)向陀螺儀第i個(gè)采樣點(diǎn)的確定性誤差項(xiàng)系數(shù),Wni表示負(fù)向陀螺儀測(cè)試時(shí)刻第i個(gè)確定性誤差項(xiàng),,i=1,...n,n=2~7,N2為負(fù)向陀螺儀測(cè)試時(shí)的測(cè)量噪聲,D2為反向陀螺儀不確定性誤差總量,Knd為反向陀螺儀環(huán)境系數(shù)??梢栽谝阎斎虢撬俣葁下,取一段時(shí)間內(nèi)m個(gè)數(shù)據(jù)做平均,以消除噪聲N的影響,由(8)和(9)可得:K‾pd=1mΣj=1mKpd·Dp=1mΣj=1m(Gp-Σi=1nKpwi·Wpi-Kp·w-N1)---(10)]]>K‾nd=1mΣj=1mKnd·Dn=1mΣj=1m(Gn-Σi=1nKnwi·Wni-Kn·w-N2)---(11)]]>相反方向上的兩個(gè)陀螺的環(huán)境系數(shù)比值Kbd為:Kbd=KpdKnd≈K‾pdK‾nd=1mΣj=1m(Gpj-Σi=1nKpwi·Wpi-Kp·w-N1)1mΣj=1m(Gnj-Σi=1nKnwi-Kni·w-N2)---(12)]]>其中,j表示每次參與數(shù)據(jù)平滑處理的數(shù)據(jù)個(gè)數(shù),j=1,...m,m=8~30,Gpj表示正向陀螺儀第j個(gè)采樣點(diǎn)的輸出值,Gnj表示負(fù)向陀螺儀第j個(gè)采樣點(diǎn)的輸出值,w為測(cè)試時(shí)刻的輸入角速度。假設(shè)量測(cè)噪聲為白噪聲,則其數(shù)學(xué)期望值為零,則相反方向上的兩個(gè)陀螺的環(huán)境系數(shù)比值Kbd為:Kbd=1mΣj=1m(Gpj-Σi=1nKpwi·Wpi-Kp·w)1mΣj=1m(Gnj-Σi=1nKnwi·Wni-Kn·w)---(13)]]>將公式(8)減去公式(9),并且兩端同時(shí)乘以Kbd,則可以獲得以下公式(14):(Gp-Σi=1nKpwi·Wpi)-(Kbd·Gn-Σi=1nKbd·Knwi·Wni)=(Kp+Kbd·Kn)·w+(Kpd-Kbd·Knd)·D+(N1-Kbd·N2)---(14)]]>因?yàn)镵pd=Kbd·Knd,則可以獲得以下公式(15):w=(Gp-Σi=1nKpwi·Wpi)-(Kbd·Gn-Σi=1nKbd·Knwi·Wni)-(N1-Kbd·N2)Kp+Kbd·Kn---(15)]]>陀螺儀的量測(cè)噪聲一般為高斯白噪聲Nc:Nc=N1-Kbd·N2Kp+Kbd·Kn---(16)]]>其中,N1為正向陀螺儀測(cè)試時(shí)的測(cè)量噪聲,N2為負(fù)向陀螺儀測(cè)試時(shí)的測(cè)量噪聲。將公式(16)帶入公式(15),則輸入角速度w的實(shí)時(shí)解算公式化簡(jiǎn)為 公式(17):w=(Gp-Σi=1nKpwi·Wpi)-(Kbd·Gn-Σi=1nKbd·Knwi·Wni)Kp+Kbd·Kn-Nc---(17).]]>本說(shuō)明書中的各個(gè)實(shí)施例均采用遞進(jìn)的方式描述,每個(gè)實(shí)施例重點(diǎn)說(shuō)明的都是與其他實(shí)施例的不同之處,各個(gè)實(shí)施例之間相同相似的部分互相參見(jiàn)即可。對(duì)于系統(tǒng)實(shí)施例而言,由于其與方法實(shí)施例基本相似,所以描述的比較簡(jiǎn)單,相關(guān)之處參見(jiàn)方法實(shí)施例的部分說(shuō)明即可。以上對(duì)本發(fā)明所提供的一種基于差分MEMS陀螺儀的高精度測(cè)量方法,進(jìn)行了詳細(xì)介紹,本文中應(yīng)用了具體個(gè)例對(duì)本發(fā)明的原理及實(shí)施方式進(jìn)行了闡述,以上實(shí)施例的說(shuō)明只是用于幫助理解本發(fā)明的方法及其核心思想;同時(shí),對(duì)于本領(lǐng)域的一般技術(shù)人員,依據(jù)本發(fā)明的思想,在具體實(shí)施方式及應(yīng)用范圍上均會(huì)有改變之處,綜上所述,本說(shuō)明書內(nèi)容不應(yīng)理解為對(duì)本發(fā)明的限制。當(dāng)前第1頁(yè)1 2 3