TWI405951B - 陀螺儀控制方法 - Google Patents
陀螺儀控制方法 Download PDFInfo
- Publication number
- TWI405951B TWI405951B TW099113261A TW99113261A TWI405951B TW I405951 B TWI405951 B TW I405951B TW 099113261 A TW099113261 A TW 099113261A TW 99113261 A TW99113261 A TW 99113261A TW I405951 B TWI405951 B TW I405951B
- Authority
- TW
- Taiwan
- Prior art keywords
- module
- gyro
- gyroscope
- body module
- control signal
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 68
- 238000013016 damping Methods 0.000 claims description 6
- 230000008859 change Effects 0.000 claims description 5
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 239000012491 analyte Substances 0.000 claims 1
- 230000010354 integration Effects 0.000 abstract description 10
- 230000008569 process Effects 0.000 abstract description 8
- 230000007547 defect Effects 0.000 abstract 2
- 238000010586 diagram Methods 0.000 description 11
- 238000005259 measurement Methods 0.000 description 7
- 230000006872 improvement Effects 0.000 description 6
- 230000004044 response Effects 0.000 description 5
- 238000013461 design Methods 0.000 description 3
- 238000012360 testing method Methods 0.000 description 3
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 239000003990 capacitor Substances 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000003071 parasitic effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/56—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
- G01C19/5719—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces using planar vibrating masses driven in a translation vibration along an axis
- G01C19/5726—Signal processing
Landscapes
- Engineering & Computer Science (AREA)
- Signal Processing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
- Micromachines (AREA)
Description
本發明係關於一種微機電陀螺儀,尤指一種無需執行離線校正程序,便可線上補償其感測電路瑕疵及其機械結構瑕疵所造成的誤差,將此微機電陀螺儀依附於一待測物上,無需積分程序便能運算出此待測物之旋轉角度的微機電陀螺儀。
近年來,微機電陀螺儀的應用領域已大幅地擴張,如作為裝設於手持裝置之運動感測器(Motion Sensor)的角度量測元件等。但是,由於微機電陀螺儀本身的限制,如微機電製程所引入的感測電路瑕疵及機械結構瑕疵,應用微機電陀螺儀所進行之角度量測的精確度仍有極大的進步空間。所以,目前的微機電陀螺儀在進行角度量測前或量測達一定時間後,均需進行一離線校正程序,以將誤差值調整至一容許範圍內。
為此,業界已提出幾種改進方式以克服機械結構瑕疵對於前述之角度量測的準確度的影響,如採用複雜的元件設計、使用特殊的微機電製程或額外執行後製程等。但是,這些改進方式均會產生額外的製程成本,且可能因為複雜的元件設計反而拉低整體製程的良率,故這些針對機械結構瑕疵改進方式仍有待進一步改進。
另一方面,業界也提出數種改進方式,如調變技術(modulation)、切換電容(switch capacitor)架構或相關二重取樣(correlated double sampling,CDS)等,以排除常見於感測電路(包含可變電容及電荷放大器之電路)中的非理想因素(感測電路瑕疵),如運算放大器的電壓偏移量、因導線產生的寄生電容、雜訊、感測電路的輸出訊號飄移量、偏壓值不確定性、差動式可變電容的不對偁性。但是,這些改進方式不僅過於複雜,更需額外設置相關電路,並不適用於極力微型化中的微機電陀螺儀。
除此之外,由於在目前的微機電陀螺儀所使用之角度量測程序中,均需先量測出陀螺儀本體模組的角速度,再利用積分程序得出旋轉角度,且積分程序往往會將量測雜訊與量測訊號一併積分,造成目前微機電陀螺儀之角度量測誤差往往更大於其角速度量測誤差。
因此,業界需要一種無需執行離線校正程序,便可線上補償其感測電路瑕疵及其機械結構瑕疵所造成的誤差,且無需積分程序便能運算出其所依附之待測物之旋轉角度的微機電陀螺儀。
本發明之主要目的係在提供一種微機電陀螺儀,俾能無需執行離線校正程序,便可線上補償其感測電路瑕疵及其機械結構瑕疵所造成的誤差而運算出其所依附之待測物之旋轉角度。
本發明之另一目的係在提供一種微機電陀螺儀,俾能無需經過積分程序,便可運算出其所依附之待測物之旋轉角度。
為達成上述目的,本發明之微機電陀螺儀係配合一待測物並包括:一陀螺儀本體模組,係具有複數個系統參數;一感測模組,係與此陀螺儀本體模組耦合,以感測此陀螺儀本體模組之一系統動態;以及一控制模組,係分別與此陀螺儀本體模組及此感測模組耦合,以接受此感測模組所感測出之此系統動態,且應用一陀螺儀控制方法控制此陀螺儀本體模組並運算出此微機電陀螺儀所依附之此待測物的一旋轉角度。其中,此陀螺儀控制方法係包括下列步驟:輸出一包括一第一外加頻率訊號及一第二外加頻率訊號的初始控制訊號至此陀螺儀本體模組,以驅動此陀螺儀本體模組;依據接受之此系統動態分別估算出此等系統參數之估計數值,再依據此等系統參數分別具有之估計數值運算出一第一補償控制訊號,且此第一補償控制訊號包括此第一外加頻率訊號及此第二外加頻率訊號;輸出此第一補償控制訊號至此陀螺儀本體模組;依據再次接受之此系統動態分別估算出此等系統參數之另一估計數值,再依據此等系統參數分別具有之另一估計數值運算出一第二補償控制訊號,且此第二補償控制訊號包括此第一外加頻率訊號及此第二外加頻率訊號;以及將此第二補償控制訊號與此第一補償控制訊號互相比較,且當此第二補償控制訊號與此第一補償控制訊號相同時,依據當時之此系統動態,應用
一濾波器單元及一角度運算單元運算出此待測物的此旋轉角度。
因此,由於本發明之微機電陀螺儀之控制模組係應用一陀螺儀控制方法控制其陀螺儀本體模組,且運算出本發明之微機電陀螺儀所依附之待測物的一旋轉角度,且其控制模組依據此陀螺儀控制方法所輸出至其陀螺儀本體模組的控制訊號(如初始控制訊號、第一補償控制訊號、第二補償控制訊號及後續的補償控制訊號等)均包含一第一外加頻率訊號及一第二外加頻率訊號,而此第一外加頻率訊號的頻率及此第二外加頻率訊號的頻率均不同於其陀螺儀本體模組的一特徵頻率,故本發明之微機電陀螺儀可將其感測電路(感測模組)瑕疵及其機械結構(陀螺儀本體模組)瑕疵所造成的誤差線上(即時)補償掉,更使得本發明之微機電陀螺儀無需執行離線校正程序,也無需積分程序,便能運算出其所依附之待測物的旋轉角度。
如圖1所示,本發明一實施例之微機電陀螺儀係配合一待測物(圖中未示)並包括:一陀螺儀本體模組11、一感測模組12及一控制模組13。其中,陀螺儀本體模組11係具有複數個系統參數(圖中未示),感測模組12則與陀螺儀本體模組11耦合,以感測陀螺儀本體模組的一系統動態(圖中未示)。此外,控制模組13係分別與陀螺儀本體模組11及感測模組12,以接受感測模組12所感測出之系統動態(圖中未示),且
應用一陀螺儀控制方法控制陀螺儀本體模組11並運算出本發明一實施例之微機電陀螺儀所依附之待測物的一旋轉角度(圖中未示)。至於前述之「系統參數」及「系統動態」的詳細內容,將詳細敘述於後。
如圖2所示,本發明一實施例之微機電陀螺儀之控制模組所應用之陀螺儀控制方法係包括下列步驟:輸出一包括一第一外加頻率訊號()及一第二外加頻率訊號()的初始控制訊號(U 0
)至此陀螺儀本體模組,以驅動此陀螺儀本體模組;依據接受之此系統動態分別估算出此等系統參數之估計數值,再依據此等系統參數分別具有之估計數值運算出一第一補償控制訊號(U 1
),且此第一補償控制訊號(U 1
)包括此第一外加頻率訊號()及此第二外加頻率訊號();輸出此第一補償控制訊號(U 1
)至此陀螺儀本體模組;依據再次接受之此系統動態分別估算出此等系統參數之另一估計數值,再依據此等系統參數分別具有之另一估計數值運算出一第二補償控制訊號(U 2
),且此第二補償控制訊號(U 2
)包括此第一外加頻率訊號()及此第二外加頻率訊號();以及將此第二補償控制訊號(U 2
)與此第一補償控制訊號(U 1
)互相比較,且當此第二補償控制訊號(U 2
)中之估計數值與此第一補償控制訊號(U 1
)中之估計數值相同時,依據當時之此系統動態,應用一濾波器單元及一角度運算單元運算出本
發明一實施例之微機電陀螺儀所依附之待測物的此旋轉角度。
以下,將配合圖式詳細敘述本發明一實施例之微機電陀螺儀之控制模組運算出本發明一實施例之微機電陀螺儀所依附之待測物之一旋轉角度的過程:如圖3所示,其係本發明一實施例之微機電陀螺儀之陀螺儀本體模組的示意圖。在本實施例中,陀螺儀本體模組11係一單軸振動式微機電陀螺儀,感測模組12則為一可變電容式位移感測器。此外,陀螺儀本體模組11之質量塊111的動態被侷限在X-Y平面上,以量測質量塊111於Z軸方向上的旋轉角速度(Ω z
)及旋轉角度。如此,質量塊111於X,Y兩軸上的動態可用下列方程式表示:
其中,m
為質量塊111的質量;d xx
、d yy
為陀螺儀本體模組於x
軸與y
軸方向上的阻尼係數;k xx
、k yy
為陀螺儀本體模組於x
軸與y
軸方向上的剛性係數;d xy
為跨軸耦合(cross axis)的阻尼係數,k xy
為跨軸耦合的剛性係數。
接著,經過處理,前述之式(1)可改寫為
但是,由於本發明一實施例之微機電陀螺儀之陀螺儀本體模組11之機械結構瑕疵的影響,上述之系統參數的數值皆可能與原先設計時的數值不同。因此,在本實施例中,陀螺儀本體模組11係具有8個系統參數,即k xx
、k yy
、k xy
、d xx
、d yy
、d xy
、Ω z
(陀螺儀本體模組的角速度)及m(陀螺儀本體模組之質量塊的質量),且這8個系統參數的實際數值係屬未知,需由控制模組13一一估計出來。
為了運算出前述之8個系統參數,本發明一實施例之微機電陀螺儀之控制模組係藉由建立一狀態觀察器的方式,依據接受自感測模組12之陀螺儀本體模組11的一系統動態,分別估算出前述之8個系統參數的估計數值。而在本實施例中,陀螺儀本體模組11的系統動態係至少包含陀螺儀本體模組11之質量塊111的位置(x
、y
)及/或質量塊111的速度(、)。
而為了建立前述之狀態觀察器,前述之動態方程式(式2)可改寫成:
其中,
如此,本發明一實施例之微機電陀螺儀之陀螺儀本體模組11的「系統動態」及「系統參數」均被整合在一動態系統中。在本實施例中,由於所有的系統參數(k xx
、k yy
、k xy
、d xx
、d yy
、d xy
、Ω z
及m)的實際數值皆為固定數值,即它們不會隨著微機電陀螺儀的運作而有所變化,故前述之狀態觀察器可表示如下:
其中,代表系統狀態的估測值,L為觀察器增益。在本實施例中,觀察器增益L係藉由一里昂普諾夫法(Lyapunov method)得出。
如前所述,本發明一實施例之微機電陀螺儀之控制模組係應用一陀螺儀控制方法(如圖2所示)運算出本發明一實施例之微機電陀螺儀所依附之待測物的一旋轉角度,而此陀螺儀控制方法的詳細應用步驟,則如下所述:首先,控制模組13係輸出一包括一第一外加頻率訊號()及一第二外加頻率訊號()的初始控制訊號(U 0
)至陀螺儀本體模組11,而此初始訊號(U 0
)可表示如下:
其中,陀螺儀本體模組11經式5之控制訊號控制後具有一特徵頻率(),而前述之第一外加頻率訊號()及一第二外加頻率訊號()均小於此特徵頻率。在本實施例中,第一外加頻率訊號()係450Hz的正弦函數訊號,第二外加頻率訊號()則為500Hz的正弦函數訊號。
其次,控制模組13依據接受自感測模組12之陀螺儀本體模組11的系統動態(x
、y
及/或、),使用前述已建立之狀態觀察器,分別估算出前述之8個系統參數的估計數值。而且,這8個系統參數的估計數值與先前運算出初始控制訊
號(U 0
)時所使用之8個系統參數的數值相比,至少有部分系統參數的數值不同。
接著,控制模組13再依據這些系統參數的估計數值運算出一第一補償控制訊號(U 1
),而此第一補償控制訊號(U 1
)仍包括前述之第一外加頻率訊號()及第二外加頻率訊號(),且可表示如下:
隨後,控制模組13輸出此第一補償控制訊號(U 1
)至陀螺儀本體模組11,以驅動陀螺儀本體模組11。之後,控制模組13便依據再次接受自感測模組12之陀螺儀本體模組11的系統動態(x
、y
及/或、),再次使用前述已建立之狀態觀察器,分別估算出前述之8個系統參數的另一估計數值。
接著,控制模組13再依據這些系統參數的另一估計數值運算出一第二補償控制訊號(U 2
),而此第二補償控制訊號(U 2
)亦包括前述之第一外加頻率訊號()及第二外加頻率訊號(),且可表示如下:
此時,控制模組13將此第二補償控制訊號(U 2
)與前述之第一補償控制訊號(U 1
)互相比較。若兩者不同時,控制模組13便將此第二補償控制訊號(U 2
)輸出至陀螺儀本體模組11,以驅動陀螺儀本體模組11。
接著,控制模組13再依據前述之程序,再次運算出一第三補償控制訊號(U 3
)並將此第三補償控制訊號(U 3
)與前述之第二補償控制訊號(U 2
)互相比較。需注意的是,控制模組13將會持續執行相同的程序,即持續運算出不同的補償控制訊號(U n
)並將補償控制訊號(U n
)輸出至陀螺儀本體模組11,直到下一次所運算出的補償控制訊號(U n
+1
)中之估計數值與目前運算出的補償訊號(U n
)中之估計數值相同為止。
如圖4所示,其係顯示當本發明一實施例之微機電陀螺儀之控制模組應用陀螺儀控制方法時,其陀螺儀本體模組之系統動態之各參數(x
、y
及/或、)之估計數值的變化趨勢示意圖。其中,系統動態的各參數(x
、y
及/或、)之估計數值均迅速地收斂至實際數值。此外,圖5則顯示本發明一實施例之微機電陀螺儀之陀螺儀本體模組所具之8個系統參數之估計數值的變化趨勢示意圖。其中,這8個系統參數(k xx
、k yy
、k xy
、d xx
、d yy
、d xy
、Ω z
及m)的估計數值均於0.3秒內收斂至實際數值。
而當此第二補償控制訊號(U 2
)中之估計數值與前述之第一補償控制訊號(U 1
)中之估計數值相同時,即當陀螺儀本體模組之系統動態之各參數的估計數值收斂至實際數值
時,且其8個系統參數的估計數值也收斂至實際數值時,控制模組13便依據運算出第二補償訊號(U 2
)所依據之系統動態,依序應用一濾波器單元及一角度運算單元,運算出本發明一實施例之微機電陀螺儀所依附之待測物的旋轉角度。
在本實施例中,前述之濾波器單元係為一帶通濾波器單元(Band-pass filter),且其頻率響應係如圖6所示。從圖6中可看出,此帶通濾波器單元的通帶係介於2.5kHz及3.5kHz之間,且前述之陀螺儀本體模組111的特徵頻率係位於此帶通濾波器單元之通帶(pass band)內,以便過濾(擷取)出頻率在此特徵頻率附近的訊號。此時,陀螺儀本體模組111的系統動態便可表示如下:
接著,控制模組13將這4個參數帶入前述之角度運算單元中,以運算出本發明一實施例之微機電陀螺儀所依附之待測物的旋轉角度()。在本實施例中,此角度運算單元可表示為:
至於運算出之待測物的旋轉角度()與待測物的實際旋轉角度之間的比較,則如圖7所示。從圖7中可看出,本發明一實施例之微機電陀螺儀之控制模組13所運算出之旋轉角度與實際旋轉角度相符,且角度運算結果對於實際角度變化的反應速度極快,不會有延遲反應(lag)的發生。
因此,本發明一實施例之微機電陀螺儀之控制模組藉由應用圖2所示之陀螺儀控制方法的方式,不但可線上補償其感測電路瑕疵及其機械結構瑕疵所造成的誤差,更無需經過複雜的積分程序,即能運算出本發明一實施例之微機電陀螺儀所依附之待測物的旋轉角度。
在本發明另一實施例之微機電陀螺儀中,所有的系統參數(k xx
、k yy
、k xy
、d xx
、d yy
、d xy
、Ω z
及m)的實際數值皆為未知,且其中某些系統參數非固定不變,即這些系統參數會隨著微機電陀螺儀的運作而有所變化。此外,由於本發明另一實施例之微機電陀螺儀之控制模組所應用之陀螺儀控制方法係與本發明一實施例之微機電陀螺儀之控制模組所應用之陀螺儀控制方法相同,故此陀螺儀控制方法的詳細應用步驟在此便不再贅述。
但是,在本實施例中,第一外加頻率訊號()及一第二外加頻率訊號()便不用如同前述之本發明一實施例之第一外加頻率訊號()及一第二外加頻率訊號()一樣,需被限定至小於陀螺儀本體模組的特徵頻率,它們僅需不同於此特徵頻率即可。而且,在本實施例中,第一外加頻率
訊號()係450Hz的正弦函數訊號,第二外加頻率訊號()則為500Hz的正弦函數訊號。
如圖8所示,其係顯示當本發明另一實施例之微機電陀螺儀之控制模組應用陀螺儀控制方法時,其陀螺儀本體模組所具之8個系統參數之估計數值的變化趨勢示意圖。其中,在0.55秒後,角速度(Ω z
)由一開始的方波變化為正旋波,系統阻尼係數(d xx
、d yy
及d xy
)因陀螺儀本體劣化而發生快速且大幅度的變化。但是,即便本發明另一實施例之微機電陀螺儀之陀螺儀本體模組發生此一變化,這8個系統參數(k xx
、k yy
、k xy
、d xx
、d yy
、d xy
、Ω z
及m)的估計數值仍可迅速地收斂至實際數值。
與本發明一實施例之微機電陀螺儀之控制模組相同,第二補償控制訊號(U 2
)中之估計數值與第一補償控制訊號(U 1
)中之估計數值相同時,本發明另一實施例之微機電陀螺儀之控制模組便依據運算出第二補償訊號(U 2
)所依據之系統動態,依序應用一濾波器單元及一角度運算單元,運算出本發明另一實施例之微機電陀螺儀所依附之待測物的旋轉角度。
在本發明另一實施例中,控制模組係先應用角度運算單元,依據運算出第二補償訊號(U 2
)時所依據之系統動態,運算出一旋轉角度的估計值()。而此角度運算單元可表示為:
接著,再應用一低通濾波器單元(Low pass filter)過濾此旋轉角度的估計值(),以運算出本發明另一實施例之微機電陀螺儀所依附之待測物的旋轉角度()。所以,待測物的旋轉角度可表示為:
而如圖9所示,其係此低通濾波器單元(Low pass filter)的頻率響應示意圖,此低通濾波器單元的導通頻率係0.2kHz,故本發明另一實施例之微機電陀螺儀之陀螺儀本體模組之角速度變化頻率的上限便為0.2kHz。
至於本發明另一實施例之微機電陀螺儀之控制模組所運算出之待測物的旋轉角度()與待測物的實際旋轉角度之間的比較,則如圖10所示。從圖10中可看出,即使在0.55秒後,本發明另一實施例之微機電陀螺儀所依附之待測物的角速度(Ω z
)由一開始的方波變化為正旋波,並且在0.45秒時,系統阻尼係數發生且大幅度的變化,本發明另一實施例之微機電陀螺儀之控制模組所運算出之旋轉角度仍與實際旋轉角度大致相符,顯示本發明另一實施例之微機電陀螺儀可將誤差值控制在一可接受的範圍內(線上誤差補
償),使得本發明另一實施例之微機電陀螺儀無需立即停機以執行額外的離線校正程序。
因此,本發明另一實施例之微機電陀螺儀之控制模組藉由應用圖2所示之陀螺儀控制方法的方式,不但可線上補償其感測電路瑕疵及其機械結構瑕疵所造成的誤差,更無需經過複雜的積分程序,即能運算出本發明另一實施例之微機電陀螺儀所依附之待測物的旋轉角度。
綜上所述,由於本發明之微機電陀螺儀之控制模組係應用一陀螺儀控制方法控制其陀螺儀本體模組,且運算出本發明之微機電陀螺儀所依附之待測物的一旋轉角度,且其控制模組依據此陀螺儀控制方法所輸出至其陀螺儀本體模組的控制訊號(如初始控制訊號、第一補償控制訊號、第二補償控制訊號及後續的補償控制訊號等)均包含一第一外加頻率訊號及一第二外加頻率訊號,而此第一外加頻率訊號的頻率及此第二外加頻率訊號的頻率均不同於其陀螺儀本體模組的一特徵頻率,故本發明之微機電陀螺儀可將其感測電路(感測模組)瑕疵及其機械結構(陀螺儀本體模組)瑕疵所造成的誤差線上(即時)補償掉,更使得本發明之微機電陀螺儀無需執行離線校正程序,也無需積分程序,便能運算出其所依附之待測物的旋轉角度。
上述實施例僅係為了方便說明而舉例而已,本發明所主張之權利範圍自應以申請專利範圍所述為準,而非僅限於上述實施例。
11‧‧‧陀螺儀本體模組
12‧‧‧感測模組
13‧‧‧控制模組
111‧‧‧質量塊
圖1係本發明一實施例之微機電陀螺儀的示意圖。
圖2係本發明一實施例之微機電陀螺儀之控制模組所應用之陀螺儀控制方法的流程示意圖。
圖3係本發明一實施例之微機電陀螺儀之陀螺儀本體模組的示意圖。
圖4係顯示當本發明一實施例之微機電陀螺儀之控制模組應用陀螺儀控制方法時,其陀螺儀本體模組之系統動態之各參數之估計數值的變化趨勢示意圖。
圖5係顯示本發明一實施例之微機電陀螺儀之陀螺儀本體模組所具之8個系統參數之估計數值的變化趨勢示意圖。
圖6係本發明一實施例之微機電陀螺儀之控制模組所應用之陀螺儀控制方法所使用之帶通濾波器的頻率響應圖。
圖7係顯示本發明一實施例之微機電陀螺儀之控制模組所運算出之旋轉角度與實際旋轉角度之間差異的示意圖。
圖8係顯示當本發明另一實施例之微機電陀螺儀之控制模組應用陀螺儀控制方法時,其陀螺儀本體模組所具之8個系統參數之估計數值的變化趨勢示意圖。
圖9係本發明另一實施例之微機電陀螺儀之控制模組所應用之陀螺儀控制方法所使用之低通濾波器的頻率響應圖。
圖10係顯示本發明另一實施例之微機電陀螺儀之控制模組所運算出之旋轉角度與實際旋轉角度之間差異的示意圖。
11‧‧‧陀螺儀本體模組
12‧‧‧感測模組
13‧‧‧控制模組
Claims (15)
- 一種陀螺儀控制方法,係應用於一微機電陀螺儀,該微機電陀螺儀配合一待測物並包括一陀螺儀本體模組、一感測模組、以及一控制模組,該陀螺儀本體模組具有複數個系統參數,該感測模組與該陀螺儀本體模組耦合,以感測該陀螺儀本體模組之一系統動態,以及該控制模組係分別與該陀螺儀本體模組及該感測模組耦合,以接受該感測模組所感測出之該系統動態,該陀螺儀控制方法係包括下列步驟:該控制模組輸出一包括一第一外加頻率訊號及一第二外加頻率訊號的初始控制訊號至該陀螺儀本體模組,以驅動該陀螺儀本體模組;該控制模組依據接受之該系統動態分別估算出該等系統參數之估計數值,再依據該等系統參數分別具有之估計數值運算出一第一補償控制訊號,且該第一補償控制訊號包括該第一外加頻率訊號及該第二外加頻率訊號;該控制模組輸出該第一補償控制訊號至該陀螺儀本體模組;該控制模組依據再次接受之該系統動態分別估算出該等系統參數之另一估計數值,再依據該等系統參數分別具有之另一估計數值運算出一第二補償控制訊號,且該第二補償控制訊號包括該第一外加頻率訊號及該第二外加頻率訊號;以及 該控制模組將該第二補償控制訊號與該第一補償控制訊號互相比較,且當該第二補償控制訊號中之估計數值與該第一補償控制訊號中之估計數值相同時,依據當時之該系統動態,應用一濾波器單元及一角度運算單元運算出該待測物的該旋轉角度;其中,該陀螺儀本體模組係具有一特徵頻率,該濾波器單元係一帶通濾波器單元,且該陀螺儀控制方法係先應用該帶通濾波器單元過濾該陀螺儀本體模組於該第二補償控制訊號中之估計數值與該第一補償控制訊號中之估計數值相同時之該系統動態,再應用該角度運算單元,依據過濾後之該系統動態運算出該待測物的該旋轉角度,該第一外加頻率訊號的頻率及該第二外加頻率訊號的頻率均小於該特徵頻率,且該特徵頻率係位於該帶通濾波器單元之通帶內。
- 如申請專利範圍第1項所述之陀螺儀控制方法,其中該微機電陀螺儀係為一振動式微機電陀螺儀。
- 如申請專利範圍第1項所述之陀螺儀控制方法,其中該等系統參數係至少包含該陀螺儀本體模組之質量塊的質量、該陀螺儀本體模組的阻尼係數、該陀螺儀本體模組的剛性係數及該陀螺儀本體模組的角速度。
- 如申請專利範圍第1項所述之陀螺儀控制方法,其中該系統動態係至少包含該陀螺儀本體模組之質量塊的位置及該陀螺儀本體模組之質量塊的速度。
- 如申請專利範圍第1項所述之陀螺儀控制方法,其中該感測模組係為一可變電容式位移感測器。
- 如申請專利範圍第1項所述之陀螺儀控制方法,其中該控制模組係藉由建立一狀態觀察器的方式,依據該系統動態分別估算出該等系統參數之估計數值。
- 如申請專利範圍第6項所述之陀螺儀控制方法,其中該狀態觀察器係具有一觀察器增益,且該觀察器增益係藉由一里昂普諾夫法得出。
- 一種陀螺儀控制方法,係應用於一微機電陀螺儀,該微機電陀螺儀配合一待測物併包括有一陀螺儀本體模組、一感測模組、以及一控制模組,該陀螺儀本體模組具有複數個系統參數,該感測模組與該陀螺儀本體模組耦合,以感測該陀螺儀本體模組之一系統動態,以及該控制模組係分別與該陀螺儀本體模組及該感測模組耦合,以接受該感測模組所感測出之該系統動態,該陀螺儀控制方法係包括下列步驟:該控制模組輸出一包括一第一外加頻率訊號及一第二外加頻率訊號的初始控制訊號至該陀螺儀本體模組,以驅動該陀螺儀本體模組;該控制模組依據接受之該系統動態分別估算出該等系統參數之估計數值,再依據該等系統參數分別具有之估計數值運算出一第一補償控制訊號,且該第一補償控制訊號包括該第一外加頻率訊號及該第二外加頻率訊號; 該控制模組輸出該第一補償控制訊號至該陀螺儀本體模組;該控制模組依據再次接受之該系統動態分別估算出該等系統參數之另一估計數值,再依據該等系統參數分別具有之另一估計數值運算出一第二補償控制訊號,且該第二補償控制訊號包括該第一外加頻率訊號及該第二外加頻率訊號;以及該控制模組將該第二補償控制訊號與該第一補償控制訊號互相比較,且當該第二補償控制訊號中之估計數值與該第一補償控制訊號中之估計數值相同時,依據當時之該系統動態,應用一濾波器單元及一角度運算單元運算出該待測物的該旋轉角度;其中,該陀螺儀本體模組係具有一特徵頻率,該濾波器單元係一低通濾波器單元,且該陀螺儀控制方法係先應用該角度運算單元,依據該陀螺儀本體模組於該第二補償控制訊號中之估計數值與該第一補償控制訊號中之估計數值相同時之該系統動態運算出一旋轉角度的估計值,再應用該低通濾波器單元過濾該旋轉角度的估計值,以運算出該待測物的該旋轉角度。
- 如申請專利範圍第8項所述之陀螺儀控制方法,其中該第一外加頻率訊號的頻率及該第二外加頻率訊號的頻率均不同於該特徵頻率,且該低通濾波器單元的導通頻率係該陀螺儀本體模組之角速度變化頻率的上限。
- 如申請專利範圍第8項所述之陀螺儀控制方法,其中該微機電陀螺儀係為一振動式微機電陀螺儀。
- 如申請專利範圍第8項所述之陀螺儀控制方法,其中該等系統參數係至少包含該陀螺儀本體模組之質量塊的質量、該陀螺儀本體模組的阻尼係數、該陀螺儀本體模組的剛性係數及該陀螺儀本體模組的角速度。
- 如申請專利範圍第8項所述之陀螺儀控制方法,其中該系統動態係至少包含該陀螺儀本體模組之質量塊的位置及該陀螺儀本體模組之質量塊的速度。
- 如申請專利範圍第8項所述之陀螺儀控制方法,其中該感測模組係為一可變電容式位移感測器。
- 如申請專利範圍第8項所述之陀螺儀控制方法,其中該控制模組係藉由建立一狀態觀察器的方式,依據該系統動態分別估算出該等系統參數之估計數值。
- 如申請專利範圍第14項所述之陀螺儀控制方法,其中該狀態觀察器係具有一觀察器增益,且該觀察器增益係藉由一里昂普諾夫法得出。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW099113261A TWI405951B (zh) | 2010-04-27 | 2010-04-27 | 陀螺儀控制方法 |
US12/845,370 US8371165B2 (en) | 2010-04-27 | 2010-07-28 | MEMS gyroscope |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW099113261A TWI405951B (zh) | 2010-04-27 | 2010-04-27 | 陀螺儀控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
TW201137310A TW201137310A (en) | 2011-11-01 |
TWI405951B true TWI405951B (zh) | 2013-08-21 |
Family
ID=44814634
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW099113261A TWI405951B (zh) | 2010-04-27 | 2010-04-27 | 陀螺儀控制方法 |
Country Status (2)
Country | Link |
---|---|
US (1) | US8371165B2 (zh) |
TW (1) | TWI405951B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI384198B (zh) * | 2009-07-09 | 2013-02-01 | Univ Nat Chiao Tung | Angle measurement gyroscope system and angle estimation method |
US8381589B2 (en) * | 2010-06-23 | 2013-02-26 | National Chiao Tung University | Single-axis-control-input gyroscope system having imperfection compensation |
FR2980570B1 (fr) * | 2011-09-26 | 2013-11-01 | Sagem Defense Securite | Calibration de gyroscope vibrant |
US9581447B2 (en) * | 2014-07-08 | 2017-02-28 | Honeywell International Inc. | MEMS gyro motor loop filter |
DE102016215975A1 (de) * | 2016-08-25 | 2018-03-01 | Robert Bosch Gmbh | Verfahren zum Betrieb eines mikromechanischen Bauelements |
CN110879553B (zh) * | 2019-12-12 | 2021-02-19 | 山东大学 | 一种基于输出状态可用的微陀螺仪的控制方法及*** |
CN113884082A (zh) * | 2021-11-09 | 2022-01-04 | 陕西华燕航空仪表有限公司 | 一种双轴mems陀螺组件及其标定补偿方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6332103B1 (en) * | 1999-06-30 | 2001-12-18 | Deka Products Limited Partnership | Apparatus and method for a pitch state estimator for a personal vehicle |
TW200504334A (en) * | 2003-07-25 | 2005-02-01 | Ind Tech Res Inst | Micro vibratory dual-axis sensitive gyroscope |
CN101158582A (zh) * | 2007-10-25 | 2008-04-09 | 北京航空航天大学 | 一种mems陀螺仪的差分测量方法 |
JP2008190980A (ja) * | 2007-02-05 | 2008-08-21 | Epson Toyocom Corp | ジャイロセンサモジュールおよび角速度検出方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI384198B (zh) * | 2009-07-09 | 2013-02-01 | Univ Nat Chiao Tung | Angle measurement gyroscope system and angle estimation method |
-
2010
- 2010-04-27 TW TW099113261A patent/TWI405951B/zh not_active IP Right Cessation
- 2010-07-28 US US12/845,370 patent/US8371165B2/en not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6332103B1 (en) * | 1999-06-30 | 2001-12-18 | Deka Products Limited Partnership | Apparatus and method for a pitch state estimator for a personal vehicle |
TW200504334A (en) * | 2003-07-25 | 2005-02-01 | Ind Tech Res Inst | Micro vibratory dual-axis sensitive gyroscope |
JP2008190980A (ja) * | 2007-02-05 | 2008-08-21 | Epson Toyocom Corp | ジャイロセンサモジュールおよび角速度検出方法 |
CN101158582A (zh) * | 2007-10-25 | 2008-04-09 | 北京航空航天大学 | 一种mems陀螺仪的差分测量方法 |
Non-Patent Citations (3)
Title |
---|
C.-Y. Chi, Y.-P. Peng, and T.-L. Chen,"Compensation of Interface Circuit Errors for MEMS Gyroscopes Using State Observer,"IEEE, The 3rd International Conference on Sensing Technology, Tainan, Taiwan, Nov 2008 * |
Chien-Yu Chi and Tsung-Lin Chen, "MEMS Gyroscope Control Systems for Direct Angle Measurements," in Proceedings of IEEE Sensors 2009 Conference, pp.492-496, Chirstchurch, New Zealand, 25-28 Oct. 2009 * |
吳柏洋,新式平面微型陀螺儀之設計與動態分析,國立成功大學機械工程學系碩士論 文,2007/7 * |
Also Published As
Publication number | Publication date |
---|---|
TW201137310A (en) | 2011-11-01 |
US20110259100A1 (en) | 2011-10-27 |
US8371165B2 (en) | 2013-02-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TWI405951B (zh) | 陀螺儀控制方法 | |
TWI384198B (zh) | Angle measurement gyroscope system and angle estimation method | |
JP3883544B2 (ja) | ロボット制御装置およびロボットの制御方法 | |
Taheri-Tehrani et al. | Disk resonator gyroscope with whole-angle mode operation | |
KR100886340B1 (ko) | 이동 로봇의 자이로 센서를 캘리브레이션하는 장치 및 방법 | |
CN109323711B (zh) | 一种陀螺仪模态反转零位自校正方法及*** | |
Lu et al. | An integrated accelerometer for dynamic motion systems | |
JP6641712B2 (ja) | 回路装置、電子機器及び移動体 | |
CN108731676B (zh) | 一种基于惯性导航技术的姿态融合增强测量方法及*** | |
US20190025056A1 (en) | Electrostatic offset correction | |
JP6697557B2 (ja) | 補助自己試験機能を備えたジャイロスコープ | |
US11125560B2 (en) | Robust method for tuning of gyroscope demodulation phase | |
US10877063B2 (en) | MEMS sensor with compensation of residual voltage | |
Hoang et al. | A new technique on vibration optimization of industrial inclinometer for MEMS accelerometer without sensor fusion | |
CN106969785B (zh) | 陀螺仪自校准装置及方法 | |
CN106644052B (zh) | 一种微振镜的反馈***及方法 | |
CN111465821A (zh) | 芯片上间隙测量 | |
KR101314151B1 (ko) | 주기적 회전 진동을 이용한 6축 진동 센서의 교정 방법 및 장치 | |
WO2006009042A1 (ja) | 角速度計測装置および脚式移動ロボット | |
US11619492B2 (en) | Sensor linearization based upon correction of static and frequency-dependent non-linearities | |
JP6802843B2 (ja) | 加速度計の残留電圧自己試験 | |
Kubus et al. | A sensor fusion approach to improve joint angle and angular rate signals in articulated robots | |
JP4509006B2 (ja) | 人工衛星の姿勢決定系 | |
Kubus et al. | A sensor fusion approach to angle and angular rate estimation | |
CN106595714B (zh) | 一种正交偏置自消除的微机械陀螺仪 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
MM4A | Annulment or lapse of patent due to non-payment of fees |