TWI384198B - Angle measurement gyroscope system and angle estimation method - Google Patents
Angle measurement gyroscope system and angle estimation method Download PDFInfo
- Publication number
- TWI384198B TWI384198B TW098123199A TW98123199A TWI384198B TW I384198 B TWI384198 B TW I384198B TW 098123199 A TW098123199 A TW 098123199A TW 98123199 A TW98123199 A TW 98123199A TW I384198 B TWI384198 B TW I384198B
- Authority
- TW
- Taiwan
- Prior art keywords
- axis
- gyroscope
- mass
- sensing
- signals
- Prior art date
Links
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)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Description
本發明是有關於一種陀螺儀系統,特別是指一種角度量測陀螺儀系統(angle-measuring gyroscope system)及其角度估算方法。
參閱圖1與圖2,一角度量測陀螺儀系統1包括一陀螺儀11、一感測模組12及一計算模組13。
陀螺儀11包括一質量塊(proof mass)111(圖2所顯示的是陀螺儀11的動態模型,而不是其實際結構)。質量塊111在一XY平面上振動。當陀螺儀11關於一正交於XY平面的軸轉動時,質量塊111的振動軸V不會跟著轉動,因此,對於陀螺儀11來說,質量塊111的振動軸會進動(precess)。
感測模組12感測質量塊111的移動,並產生感測信號。該計算模組13根據感測模組12所產生的感測信號,計算陀螺儀11的轉動角度Φ。
一種習知的計算轉動角度Φ之方式是根據感測信號間接計算出陀螺儀11的轉動角度Φ,也就是先根據感測信號計算出陀螺儀11的轉動角速度,再對轉動角速度積分,以得到陀螺儀11的轉動角度Φ。另一種習知的計算轉動角度Φ之方式是根據感測信號直接計算出陀螺儀11的轉動角度Φ。然而,陀螺儀11的瑕疵、感測模組12的瑕疵、感測信號的飄移及雜訊都會使計算出的轉動角度Φ帶有誤差。
一種習知的降低轉動角度Φ的誤差之方式是使用複雜的結構設計或額外的製程調整來減少陀螺儀11的瑕疵所造成的影響,例如美國專利第6481285號及美國專利第6928874號所揭露的。
另一種習知的降低轉動角度Φ的誤差之方式是使用複雜的電路設計來減少感測模組12的瑕疵,例如2005年Proceedings of the Second International Workshop on Network Sensing Systems第119-123頁”A low noise capacitive sensing amplifier for CMOS-MEMS gyroscope with 1 mili-watt power dissipation”論文所揭露的。
又一種習知的降低轉動角度Φ的誤差之方式是計算模組13更根據感測信號計算控制信號,角度量測陀螺儀系統1更利用一驅動模組(圖未示)根據控制信號來控制質量塊111的振動,以減少陀螺儀11的瑕疵所造成的影響,例如美國專利第 6481285號、美國專利第 6928874號、美國專利第 6934660號、2004年Journal of Dynamic Systems,Measurement,and Control第126卷第4期第800-810頁”New adaptive mode of operation for MEMS gyroscopes”論文,及2008年Sensors and Actuators A第144卷第1期第56-63頁”Dynamics and control of a MEMS angle measuring gyroscope”論文所揭露的,但是這無法減少感測模組12的瑕疵及感測信號的飄移所造成的影響。
因此,本發明之目的即在提供一種使用狀態觀察器的角度量測陀螺儀系統,可以減少感測模組的瑕疵及感測信號的飄移所造成的影響。
於是,本發明角度量測陀螺儀系統包含一陀螺儀、一感測模組及一計算模組。
該陀螺儀包括一質量塊。該質量塊在正交的一第一軸及一第二軸所構成的一平面上振動。
該感測模組用於感測該質量塊的移動,並產生一組感測信號。該組感測信號反應該質量塊於該第一軸之位置及該質量塊於該第二軸之位置。
該計算模組電連接到該感測模組,且包括一狀態觀察器及一角度計算器。
該狀態觀察器用於根據一組估計參數計算與該組感測信號對應的一組估計信號,並根據該陀螺儀的動態方程式得到一增益,且根據該陀螺儀的動態方程式、該增益、該組感測信號及該組估計信號更新該組估計參數。該組估計參數與一組系統參數對應。該組系統參數包括該質量塊於該第一軸的位置、該質量塊於該第二軸的位置、該質量塊於該第一軸的速度、該質量塊於該第二軸的速度、該感測模組於該第一軸的感測誤差、該感測模組於該第二軸的感測誤差,及該陀螺儀於一第三軸的轉動角速度。該第三軸正交於該第一軸及該第二軸。
該角度計算器用於根據該組估計參數中對應位置與速度的參數,及該陀螺儀的剛性係數,計算該陀螺儀於該第三軸的轉動角度。
而本發明之另一目的即在提供一種使用狀態觀察器的角度估算方法,可以減少感測模組的瑕疵及感測信號的飄移所造成的影響。
於是,本發明角度估算方法運用於一包括一陀螺儀及一感測模組的角度量測陀螺儀系統。該陀螺儀包括一質量塊。該質量塊在正交的一第一軸及一第二軸所構成的一平面上振動。該感測模組感測該質量塊的移動,並產生一組感測信號。該組感測信號反應該質量塊於該第一軸之位置及該質量塊於該第二軸之位置。該角度估算方法包含以下步驟:
(a)利用一狀態觀察器來根據一組估計參數計算與該組感測信號對應的一組估計信號,該組估計參數與一組系統參數對應,該組系統參數包括該質量塊於該第一軸的位置、該質量塊於該第二軸的位置、該質量塊於該第一軸的速度、該質量塊於該第二軸的速度、該感測模組於該第一軸的感測誤差、該感測模組於該第二軸的感測誤差,及該陀螺儀於一第三軸的轉動角速度,該第三軸正交於該第一軸及該第二軸;
(b)利用該狀態觀察器來根據該陀螺儀的動態方程式得到一增益;
(c)利用該狀態觀察器來根據該陀螺儀的動態方程式、該增益、該組感測信號及該組估計信號更新該組估計參數;及
(d)根據該組估計參數中對應位置與速度的參數,及該陀螺儀的剛性係數,計算該陀螺儀於該第三軸的轉動角度。
而本發明之另一目的即在提供一種使用狀態觀察器的角度量測陀螺儀系統,可以減少陀螺儀的瑕疵所造成的影響。
於是,本發明角度量測陀螺儀系統包含一陀螺儀、一感測模組、一計算模組及一驅動模組。
該陀螺儀包括一質量塊。該質量塊在正交的一第一軸及一第二軸所構成的一平面上振動。
該感測模組用於感測該質量塊的移動,並產生一組感測信號。該組感測信號反應該質量塊於該第一軸之位置及該質量塊於該第二軸之位置。
該計算模組電連接到該感測模組,且包括一狀態觀察器、一控制信號計算器及一角度計算器。
該狀態觀察器用於根據一組估計參數計算與該組感測信號對應的一組估計信號,並根據該陀螺儀的動態方程式得到一增益,且根據該陀螺儀的動態方程式、該增益、該組感測信號及該組估計信號更新該組估計參數。該組估計參數與一組系統參數對應。該組系統參數包括該質量塊於該第一軸的位置、該質量塊於該第二軸的位置、該質量塊於該第一軸的速度、該質量塊於該第二軸的速度、該陀螺儀於一第三軸的轉動角速度、該陀螺儀於該第一軸的剛性係數、該陀螺儀於該第二軸的剛性係數、該陀螺儀之影響耦合的剛性係數、該陀螺儀於該第一軸的阻尼係數、該陀螺儀於該第二軸的阻尼係數,及該陀螺儀之影響耦合的阻尼係數。該第三軸正交於該第一軸及該第二軸。
該控制信號計算器用於根據該組估計參數中對應剛性係數、阻尼係數、位置及速度的參數,以及一預設的目標剛性係數,計算一組控制信號。
該角度計算器用於根據該組估計參數中對應位置與速度的參數,及該目標剛性係數,計算該陀螺儀於該第三軸的轉動角度。
該驅動模組電連接到該計算模組,用於根據該組控制信號產生一組控制力來控制該質量塊的振動。
而本發明之另一目的即在提供一種使用狀態觀察器的角度估算方法,可以減少陀螺儀的瑕疵所造成的影響。
於是,本發明角度估算方法運用於一包括一陀螺儀、一感測模組及一驅動模組的角度量測陀螺儀系統。該陀螺儀包括一質量塊。該質量塊在正交的一第一軸及一第二軸所構成的一平面上振動。該感測模組感測該質量塊的移動,並產生一組感測信號。該組感測信號反應該質量塊於該第一軸之位置及該質量塊於該第二軸之位置。該驅動模組根據一組控制信號產生一組控制力來控制該質量塊的振動。該角度估算方法包含以下步驟:
(a)利用一狀態觀察器來根據一組估計參數計算與該組感測信號對應的一組估計信號,該組估計參數與一組系統參數應該,該組系統參數包括該質量塊於該第一軸的位置、該質量塊於該第二軸的位置、該質量塊於該第一軸的速度、該質量塊於該第二軸的速度、該陀螺儀於一第三軸的轉動角速度、該陀螺儀於該第一軸的剛性係數、該陀螺儀於該第二軸的剛性係數、該陀螺儀之影響耦合的剛性係數、該陀螺儀於該第一軸的阻尼係數、該陀螺儀於該第二軸的阻尼係數,及該陀螺儀之影響耦合的阻尼係數,該第三軸正交於該第一軸及該第二軸;
(b)利用該狀態觀察器來根據該陀螺儀的動態方程式得到一增益;
(c)根據該組估計參數中對應剛性係數、阻尼係數、位置及速度的參數,以及一預設的目標剛性係數,計算該組控制信號;
(d)利用該狀態觀察器來根據該陀螺儀的動態方程式、該增益、該組感測信號及該組估計信號更新該組估計參數;及
(e)根據該組估計參數中對應位置與速度的參數,及該目標剛性係數,計算該陀螺儀於該第三軸的轉動角度。
有關本發明之前述及其他技術內容、特點與功效,在以下配合參考圖式之一個較佳實施例的詳細說明中,將可清楚地呈現。
參閱圖3,本發明角度量測陀螺儀系統2之較佳實施例包含一陀螺儀21、一感測模組22、一計算模組23及一驅動模組24。
參閱圖3與圖4,陀螺儀21包括一質量塊211(圖4所顯示的是陀螺儀21的動態模型,而不是其實際結構)。質量塊211在正交的一第一軸X及一第二軸Y所構成的一XY平面上振動,且其振動會受一組控制力影響。
質量塊211的動態方程式如式(1)所示:
其中,x
、y
分別是質量塊211於第一軸X及第二軸Y的位置,分別是質量塊211於第一軸X及第二軸Y的速度(即位置之一次微分),分別是質量塊211於第一軸X及第二軸Y的加速度(即位置之二次微分),m
是質量塊211的質量,d xx
及d yy
分別是陀螺儀21於第一軸X及第二軸Y的阻尼係數,k xx
及k yy
分別是陀螺儀21於第一軸X及第二軸Y的剛性係數,d xy
及k xy
分別是陀螺儀21之影響耦合的阻尼係數及剛性係數,Ω z
是陀螺儀21於一第三軸Z(正交於第一軸X及第二軸Y)的轉動角速度,u x
是陀螺儀21於第一軸X被施加的控制力,u y
是陀螺儀21於第二軸Y被施加的控制力。
在質量塊211的質量為已知的情況下,可以據此來正規化(normalize)式(1)而得到式(2):
由於陀螺儀21的瑕疵之影響,、、、、、及Ωz
皆可能不同於設計值。因此,在考慮陀螺儀21的瑕疵之情況下,陀螺儀21共有7個未知參數,也就是、、、、、及Ωz
。
值得注意的是,在本實施例中,陀螺儀21是一單軸感測陀螺儀,但在其它實施例中,陀螺儀21可以是一多軸感測陀螺儀,且本領域中具有通常知識者可以根據以上說明推得多軸感測的情況,因此將不多加說明。
參閱圖3,感測模組22感測質量塊211的移動,並產生一組感測信號。該組感測信號包括一反應質量塊211於第一軸X之位置的第一感測信號及一反應質量塊211於第二軸Y之位置的第二感測信號。
感測模組22包括一感測介面221及一感測電路222。感測介面221將質量塊211的移動轉換成一種方便量測的形式,例如穿隧電流(tunneling current)、光學影像、電阻(利用壓阻(piezoresistance)或壓電(piezoelectric)效應)或電容(利用可變電容器)等。感測電路222電連接到感測介面221,並將感測介面221轉換出的形式轉換成呈電壓形式的該組感測信號。
值得注意的是,在本實施例中,感測介面221是採用梳狀(comb)可變電容器架構,感測電路222是採用電荷積分架構,但本領域中具有通常知識者可以根據以下說明推得其它架構的情況,因此將不多加說明。
參閱圖5與圖6,感測介面221在第一軸X及第二軸Y中的每一軸上形成兩個差動的可變電容器2211、2212,其中,可變電容器2211具有一接收一第一直流偏壓+V的第一端,及一第二端,且其初始電容值是Co1
,可變電容器2212具有一電連接到可變電容器2211之第二端的第一端,及一接收一第二直流偏壓-V的第二端,且其初始電容值是Co2
。
對於每一軸X、Y而言,在考慮質量塊211原本即偏離一初始位置d的情況下,可變電容器2211的初始電容值C o 1
及可變電容器2212的初始電容值C o 2
之差異如式(3)所示,且當質量塊211的位置改變時(對第一軸而言為x
,對第二軸而言為y
),可變電容器2211的電容值變為C o 1
+ΔC 1
,可變電容器2212的電容值變為C o 2
-ΔC 2
,可變電容器2211、2212的電容值變化ΔC 1
、ΔC 2
如式(3)所示:
其中,N
為梳狀架構的對數(圖5只繪出N
=3的情況),ε為介電常數(permittivity),W
及Z
分別為重疊區域的寬度及間隔距離。
感測電路222對於第一軸X及第二軸Y中的每一軸利用一電荷積分器(未標號)來進行轉換。每一電荷積分器包括一運算放大器2221、一回授電容器2222及一回授電阻器2223,其中,運算放大器2221包括一反向輸入端、一電連接到地的非反向輸入端,及一輸出感測信號V o
的輸出端(對第一軸X而言是輸出第一感測信號,對第二軸Y而言是輸出第二感測信號),回授電容器2222電連接在運算放大器2221的反向輸入端及輸出端之間,回授電阻器2223電連接在運算放大器2221的反向輸入端及輸出端之間。
在考慮運算放大器2221的輸入偏置電壓(offset voltage)(其值為V os
)及導線所產生的寄生電容(其值為C p
)的情況下,感測信號V o
如式(4)所示:
在式(4)中,等號右邊的第一項是質量塊211的位置與感測信號之理想關係,等號右邊的第二項是感測介面221的瑕疵所造成的影響,等號右邊的第三項是感測電路222的瑕疵所造成的影響。
結合式(3)與式(4),並考慮感測信號的飄移及雜訊,該組感測信號可以修正為如式(5)所示:
下標x
表示與第一軸X相關,下標y
表示與第二軸Y相關,Φ是感測模組22的瑕疵及感測信號的飄移所造成的影響,也就是感測模組22的感測誤差,n
是雜訊,x 0
是在第一軸X上的可變電容2211、2212的重疊區域之初始長度,y 0
是在第二軸Y上的可變電容2211、2212的重疊區域之初始長度,α是感測信號的飄移。
由於感測模組22的瑕疵及感測信號的飄移之影響,C px
、C py
、V osx
、V osy
、d x
、d y
、x 0
、y 0
、α x
及α y
皆是未知的。因此,在考慮感測模組22的瑕疵及感測信號的飄移之情況下,感測模組22共有2個未知參數,也就是Φ x
及Φ y
。
參閱圖3,計算模組23電連接到感測模組,並根據該組感測信號計算一組控制信號及陀螺儀21於第三軸Z的轉動角度Φ。驅動模組24電連接到計算模組23,並根據該組控制信號產生該組控制力來控制質量塊211的振動,以補償陀螺儀21的瑕疵。
以下說明本實施例的控制原理及計算模組23的詳細動作。
式(2)及式(5)可以改寫成如式(6)所示的連續形式:
X
是本實施例欲求出的一組系統參數,是該組系統參數的一次微分,U
是與該組控制力對應的該組控制信號,Z
是該組感測信號,描述陀螺儀21的動態方程式,Z=HX
描述該組系統參數與該組感測信號的理想關係,且H
是已知的,是雜訊。
式(6)可以再改寫成如式(7)所示的離散形式,以方便進行疊代運算:
其中,m
表示疊代次數,d
表示離散化。
根據式(7)可以建立一離散的狀態觀察器,如式(8)所示
其中,是與該組系統參數對應的一組估計參數,L
是根據陀螺儀21的動態方程式得到的一增益,是與該組感測信號對應的一組估計信號。
該組控制信號可以設計成如式(9)所示:
其中,k
是一預設的目標剛性係數。
如果給定該組估計參數的初始值,則在進行足夠多次的疊代運算後,該組估計參數會收斂到正確值,以求出該組系統參數,此時,陀螺儀21的剛性係數趨近目標剛性數,陀螺儀21的阻尼係數趨近一預設為0的目標阻尼係數,陀螺儀21的動態方程式如式(10)所示:
利用B. Friedland與M. Hutton在1978年針對式(10)所推導出的角度計算公式(如式(11)所示),即可計算出陀螺儀21於第三軸Z的轉動角度Φ。
因此,計算模組23包括一狀態觀察器231、一控制信號計算器232及一角度計算器233。狀態觀察器231電連接到感測模組22的感測電路222,並利用式(8)計算出該組估計參數。控制信號計算器232電連接到狀態觀察器231,並利用式(9)計算出該組控制信號。角度計算器233電連接到狀態觀察器231,並利用式(11)計算出陀螺儀21的轉動角度Φ。
在本實施例中,狀態觀察器231是使用一擴增型卡曼濾波器(extended Kalman filter)及一記憶褪去(fading memory)技術,來根據陀螺儀21的動態方程式、該組感測信號及該組估計信號計算增益。藉由使用擴增型卡曼濾波器,可以減少雜訊所造成的影響。藉由使用記憶褪去技術,可以在該組系統參數中有時變參數時,仍能計算出該組估計參數的正確值,以求出該組系統參數。
擴增型卡曼濾波器及記憶褪去技術的詳細作法可以參考John Wiley & Sons於2003年出版Y. Bar-Shalom、X. R. Li及T. Kirubarajan所著的”Estimation with applications to tracking and navigation”一書,此處將不多加說明。
值得注意的是,狀態觀察器是習知的,且原先的用途是根據一系統中有限的感測信號計算出系統中未知的動態參數(表示運動中狀態),且假設系統中的固定參數是已知的。以本實施例來說,該組系統參數中的位置與速度是動態參數,該組系統參數中的剛性係數與阻尼係數是固定參數,該組系統參數中的轉動角速度是量測參數。但本實施例藉由特別整理出的式(7),就可以使用習知的狀態觀察器來計算該組估計參數,以求出包括非動態參數的該組系統參數。
值得注意的是,在本實施例中,計算模組23是計算陀螺儀21經正規化的6個未知參數,也就是 及,以及與經正規化的該組控制力對應的2個控制信號,也就是及,但在其它實施例中,計算模組23可以是計算陀螺儀21未經正規化的6個未知參數,也就是d xx
、d yy
、d xy
、k xx
、k yy
及k xy
,以及與未經正規化的該組控制力對應的2個控制信號,也就是u x
及u y
。
參閱圖7,計算模組23所使用的角度估算方法包含以下步驟:
步驟31是狀態觀察器231根據該組估計參數計算該組估計信號。
步驟32是狀態觀察器231根據陀螺儀21的動態方程式、該組感測信號及該組估計信號計算增益。
步驟33是控制信號計算器232根據該組估計參數中對應剛性係數、阻尼係數、位置及速度的參數,以及目標剛性係數,計算該組控制信號。
步驟34是狀態觀察器231根據陀螺儀21的動態方程式、增益、該組感測信號及該組估計信號更新該組估計參數。
步驟35是角度計算器233根據該組估計參數中對應位置與速度的參數,及目標剛性係數,計算陀螺儀21於第三軸Z的轉動角度。
綜上所述,本實施例藉由計算模組23使用狀態觀察器231來計算陀螺儀21的參數及感測信號的誤差,可以降低陀螺儀21的瑕疵所造成的影響,以及感測模組22的瑕疵及感測信號的飄移所造成的影響,故確實能達成本發明之目的。
惟以上所述者,僅為本發明之較佳實施例而已,當不能以此限定本發明實施之範圍,即大凡依本發明申請專利範圍及發明說明內容所作之簡單的等效變化與修飾,皆仍屬本發明專利涵蓋之範圍內。
1‧‧‧角度量測陀螺儀系統
11‧‧‧陀螺儀
111‧‧‧質量塊
12‧‧‧感測模組
13‧‧‧計算模組
2‧‧‧角度量測陀螺儀系統
21‧‧‧陀螺儀
211‧‧‧質量塊
22‧‧‧感測模組
221‧‧‧感測介面
2211‧‧‧可變電容器
2212‧‧‧可變電容器
222‧‧‧感測電路
2221‧‧‧運算放大器
2222‧‧‧回授電容器
2223‧‧‧回授電阻器
23‧‧‧計算模組
231‧‧‧狀態觀察器
232‧‧‧控制信號計算器
233‧‧‧角度計算器
24‧‧‧驅動模組
31~35‧‧‧步驟
圖1是一方塊圖,說明一角度量測陀螺儀系統;圖2是一示意圖,說明一質量塊的振動軸之慣性;圖3是一方塊圖,說明本發明角度量測陀螺儀系統之較佳實施例;圖4是一示意圖,說明較佳實施例的一陀螺儀的動態模型;圖5是一結構圖,說明較佳實施例的一感測模組的一感測介面;圖6是一電路圖,說明較佳實施例的感測模組;圖7是一流程圖,說明較佳實施例之一計算模組所使用的角度估算方法。
2...角度量測陀螺儀系統
21...陀螺儀
22...感測模組
221...感測介面
222...感測電路
23...計算模組
231...狀態觀察器
232...控制信號計算器
233...角度計算器
24...驅動模組
Claims (26)
- 一種角度量測陀螺儀系統,包含:一陀螺儀,包括一質量塊,該質量塊在正交的一第一軸及一第二軸所構成的一平面上振動;一感測模組,用於感測該質量塊的移動,並產生一組感測信號,該組感測信號反應該質量塊於該第一軸之位置及該質量塊於該第二軸之位置;及一計算模組,電連接到該感測模組,且包括:一狀態觀察器,用於根據一組估計參數計算與該組感測信號對應的一組估計信號,並根據該陀螺儀的動態方程式得到一增益,且根據該陀螺儀的動態方程式、該增益、該組感測信號及該組估計信號更新該組估計參數,該組估計參數與一組系統參數對應,該組系統參數包括該質量塊於該第一軸的位置、該質量塊於該第二軸的位置、該質量塊於該第一軸的速度、該質量塊於該第二軸的速度、該感測模組於該第一軸的感測誤差、該感測模組於該第二軸的感測誤差,及該陀螺儀於一第三軸的轉動角速度,該第三軸正交於該第一軸及該第二軸;及一角度計算器,用於根據該組估計參數中對應位置與速度的參數,及該陀螺儀的剛性係數,計算該陀螺儀於該第三軸的轉動角度。
- 依據申請專利範圍第1項所述之角度量測陀螺儀系統,其中,該狀態觀察器是根據該陀螺儀的動態方程式、該組感測信號及該組估計信號計算該增益。
- 依據申請專利範圍第2項所述之角度量測陀螺儀系統,其中,該狀態觀察器是使用一擴增型卡曼濾波器來計算該增益。
- 依據申請專利範圍第2項所述之角度量測陀螺儀系統,其中,該狀態觀察器是使用一擴增型卡曼濾波器及一記憶褪去技術來計算該增益。
- 一種角度估算方法,運用於一包括一陀螺儀及一感測模組的角度量測陀螺儀系統,該陀螺儀包括一質量塊,該質量塊在正交的一第一軸及一第二軸所構成的一平面上振動,該感測模組感測該質量塊的移動,並產生一組感測信號,該組感測信號反應該質量塊於該第一軸之位置及該質量塊於該第二軸之位置,該角度估算方法包含以下步驟:(a)利用一狀態觀察器來根據一組估計參數計算與該組感測信號對應的一組估計信號,該組估計參數與一組系統參數對應,該組系統參數包括該質量塊於該第一軸的位置、該質量塊於該第二軸的位置、該質量塊於該第一軸的速度、該質量塊於該第二軸的速度、該感測模組於該第一軸的感測誤差、該感測模組於該第二軸的感測誤差,及該陀螺儀於一第三軸的轉動角速度,該第三軸正交於該第一軸及該第二軸;(b)利用該狀態觀察器來根據該陀螺儀的動態方程式得到一增益;(c)利用該狀態觀察器來根據該陀螺儀的動態方程式、該增益、該組感測信號及該組估計信號更新該組估計參數;及(d)根據該組估計參數中對應位置與速度的參數,及該陀螺儀的剛性係數,計算該陀螺儀於該第三軸的轉動角度。
- 依據申請專利範圍第5項所述之角度估算方法,其中,在步驟(d)中,計算該陀螺儀於該第三軸的轉動角度之方式是:
- 依據申請專利範圍第5項所述之角度估算方法,其中,在步驟(c)中,更新該組估計參數的方式是:
- 依據申請專利範圍第5項所述之角度估算方法,其中,在步驟(b)中,是根據該陀螺儀的動態方程式、該組感測信號及該組估計信號計算該增益。
- 依據申請專利範圍第8項所述之角度估算方法,其中,在步驟(b)中,是使用一擴增型卡曼濾波器來計算該增益。
- 依據申請專利範圍第8項所述之角度估算方法,其中,在步驟(b)中,是使用一擴增型卡曼濾波器及一記憶褪去技術來計算該增益。
- 一種角度量測陀螺儀系統,包含:一陀螺儀,包括一質量塊,該質量塊在正交的一第一軸及一第二軸所構成的一平面上振動;一感測模組,用於感測該質量塊的移動,並產生一組感測信號,該組感測信號反應該質量塊於該第一軸之位置及該質量塊於該第二軸之位置;一計算模組,電連接到該感測模組,且包括:一狀態觀察器,用於根據一組估計參數計算與該組感測信號對應的一組估計信號,並根據該陀螺儀的動態方程式得到一增益,且根據該陀螺儀的動態方程式、該增益、該組感測信號及該組估計信號更新該組估計參數,該組估計參數與一組系統參數對應,該組系統參數包括該質量塊於該第一軸的位置、該質量塊於該第二軸的位置、該質量塊於該第一軸的速度、該質量塊於該第二軸的速度、該陀螺陀螺儀之影響耦合的剛性係數、該陀螺儀於該第一軸的阻尼係數、該陀螺儀於該第二軸的阻尼係數,及該陀螺儀之影響耦合的阻尼係數,該第三軸正交於該第一軸及該第二軸;一控制信號計算器,用於根據該組估計參數中對應剛性係數、阻尼係數、位置及速度的參數,以及一預設的目標剛性係數,計算一組控制信號;及一角度計算器,用於根據該組估計參數中對應位置與速度的參數,及該目標剛性係數,計算該陀螺儀於該第三軸的轉動角度;及一驅動模組,電連接到該計算模組,用於根據該組控制信號產生一組控制力來控制該質量塊的振動。
- 依據申請專利範圍第11項所述之角度量測陀螺儀系統,其中,該組系統參數更包括該感測模組於該第一軸的感測誤差及該感測模組於該第二軸的感測誤差。
- 依據申請專利範圍第11項所述之角度量測陀螺儀系統,其中,該狀態觀察器是根據該陀螺儀的動態方程式、該組感測信號及該組估計信號計算該增益。
- 依據申請專利範圍第13項所述之角度量測陀螺儀系統,其中,該狀態觀察器是使用一擴增型卡曼濾波器來計算該增益。
- 依據申請專利範圍第13項所述之角度量測陀螺儀系統,其中,該狀態觀察器是使用一擴增型卡曼濾波器及一記憶褪去技術來計算該增益。
- 依據申請專利範圍第11項所述之角度量測陀螺儀系統,其中,在該組系統參數中,該陀螺儀於該第一軸的剛性係數、該陀螺儀於該第二軸的剛性係數、該陀螺儀之影響耦合的剛性係數、該陀螺儀於該第一軸的阻尼係數、該陀螺儀於該第二軸的阻尼係數,及該陀螺儀之影響耦合的阻尼係數是經正規化的參數,且是以該質量塊的質量來正規化的。
- 依據申請專利範圍第11項所述之角度量測陀螺儀系統,其中,在該組系統參數中,該陀螺儀於該第一軸的剛性係數、該陀螺儀於該第二軸的剛性係數、該陀螺儀之影響耦合的剛性係數、該陀螺儀於該第一軸的阻尼係數、該陀螺儀於該第二軸的阻尼係數,及該陀螺儀之影響耦合的阻尼係數是未經正規化的參數。
- 一種角度估算方法,運用於一包括一陀螺儀、一感測模組及一驅動模組的角度量測陀螺儀系統,該陀螺儀包括一質量塊,該質量塊在正交的一第一軸及一第二軸所構成的一平面上振動,該感測模組感測該質量塊的移動,並產生一組感測信號,該組感測信號反應該質量塊於該第一軸之位置及該質量塊於該第二軸之位置,該驅動模組根據一組控制信號產生一組控制力來控制該質量塊的振動,該角度估算方法包含以下步驟:(a)利用一狀態觀察器來根據一組估計參數計算與該組感測信號對應的一組估計信號,該組估計參數與一組系統參數對應,該組系統參數包括該質量塊於該第一軸的位置、該質量塊於該第二軸的位置、該質量塊於該第一軸的速度、該質量塊於該第二軸的速度、該陀螺儀於一第三軸的轉動角速度、該陀螺儀於該第一軸的剛性係數、該陀螺儀於該第二軸的剛性係數、該陀螺儀之影響耦合的剛性係數、該陀螺儀於該第一軸的阻尼係數、該陀螺儀於該第二軸的阻尼係數,及該陀螺儀之影響耦合的阻尼係數,該第三軸正交於該第一軸及該第二軸;(b)利用該狀態觀察器來根據該陀螺儀的動態方程式得到一增益;(c)根據該組估計參數中對應剛性係數、阻尼係數、位置及速度的參數,以及一預設的目標剛性係數,計算該組控制信號;(d)利用該狀態觀察器來根據該陀螺儀的動態方程式、該增益、該組感測信號及該組估計信號更新該組估計參數;及(e)根據該組估計參數中對應位置與速度的參數,及該目標剛性係數,計算該陀螺儀於該第三軸的轉動角度。
- 依據申請專利範圍第18項所述之角度估算方法,其中,在步驟(e)中,計算該陀螺儀於該第三軸的轉動角度之方式是:
- 依據申請專利範圍第18項所述之角度估算方法,其中,在步驟(d)中,更新該組估計參數的方式是:
- 依據申請專利範圍第18項所述之角度估算方法,其中,該組系統參數更包括該感測模組於該第一軸的感測誤差及該感測模組於該第二軸的感測誤差。
- 依據申請專利範圍第18項所述之角度估算方法,其中,在步驟(b)中,是根據該陀螺儀的動態方程式、該組感測信號及該組估計信號計算該增益。
- 依據申請專利範圍第22項所述之角度估算方法,其中,在步驟(b)中,是使用一擴增型卡曼濾波器來計算該增益。
- 依據申請專利範圍第22項所述之角度估算方法,其中,在步驟(b)中,是使用一擴增型卡曼濾波器及一記憶褪去技術來計算該增益。
- 依據申請專利範圍第18項所述之角度估算方法,其中,在該組系統參數中,該陀螺儀於該第一軸的剛性係數、該陀螺儀於該第二軸的剛性係數、該陀螺儀之影響耦合的剛性係數、該陀螺儀於該第一軸的阻尼係數、該陀螺儀於該第二軸的阻尼係數,及該陀螺儀之影響耦合的阻尼係數是經正規化的參數,且是以該質量塊的質量來正規化的。
- 依據申請專利範圍第18項所述之角度估算方法,其中,在該組系統參數中,該陀螺儀於該第一軸的剛性係數、該陀螺儀於該第二軸的剛性係數、該陀螺儀之影響耦合的剛性係數、該陀螺儀於該第一軸的阻尼係數、該陀螺儀於該第二軸的阻尼係數,及該陀螺儀之影響耦合的阻尼係數是未經正規化的參數。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW098123199A TWI384198B (zh) | 2009-07-09 | 2009-07-09 | Angle measurement gyroscope system and angle estimation method |
US12/611,268 US8166817B2 (en) | 2009-07-09 | 2009-11-03 | Angle-measuring method and angle-measuring gyroscope system for implementing the same |
JP2009298538A JP5139412B2 (ja) | 2009-07-09 | 2009-12-28 | 角度測定の方法およびそれを実施するための角度測定ジャイロシステム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW098123199A TWI384198B (zh) | 2009-07-09 | 2009-07-09 | Angle measurement gyroscope system and angle estimation method |
Publications (2)
Publication Number | Publication Date |
---|---|
TW201102616A TW201102616A (en) | 2011-01-16 |
TWI384198B true TWI384198B (zh) | 2013-02-01 |
Family
ID=43426432
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW098123199A TWI384198B (zh) | 2009-07-09 | 2009-07-09 | Angle measurement gyroscope system and angle estimation method |
Country Status (3)
Country | Link |
---|---|
US (1) | US8166817B2 (zh) |
JP (1) | JP5139412B2 (zh) |
TW (1) | TWI384198B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI405951B (zh) * | 2010-04-27 | 2013-08-21 | Univ Nat Chiao Tung | 陀螺儀控制方法 |
US8381589B2 (en) * | 2010-06-23 | 2013-02-26 | National Chiao Tung University | Single-axis-control-input gyroscope system having imperfection compensation |
TWI416070B (zh) * | 2011-12-26 | 2013-11-21 | Ind Tech Res Inst | 陀螺儀的讀取電路 |
FI125238B (en) | 2012-06-29 | 2015-07-31 | Murata Manufacturing Co | Improved vibration gyroscope |
FI124624B (en) | 2012-06-29 | 2014-11-14 | Murata Manufacturing Co | Improved vibration gyroscope |
US9823074B2 (en) * | 2012-08-08 | 2017-11-21 | Nxp Usa, Inc. | Micro-electro-mechanical system drive-mode oscillator module and method therefor |
EP2789976B1 (fr) * | 2013-04-10 | 2016-01-13 | EM Microelectronic-Marin SA | Circuit électronique d'entraînement d'un dispositif à résonateur du type MEMS, et procédé pour sa mise en action |
US10391490B2 (en) * | 2013-05-31 | 2019-08-27 | Celsee Diagnostics, Inc. | System and method for isolating and analyzing cells |
TWI510996B (zh) * | 2013-10-03 | 2015-12-01 | Acer Inc | 控制觸控面板的方法以及使用該方法的可攜式電腦 |
FI127203B (en) | 2015-05-15 | 2018-01-31 | Murata Manufacturing Co | Vibrating micromechanical sensor for angular velocity |
US10393769B2 (en) * | 2016-06-10 | 2019-08-27 | Nxp Usa, Inc. | Microelectromechanical device and a method of damping a mass thereof |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6481285B1 (en) * | 1999-04-21 | 2002-11-19 | Andrei M. Shkel | Micro-machined angle-measuring gyroscope |
US6928874B2 (en) * | 2002-11-15 | 2005-08-16 | The Regents Of The University Of California | Dynamically amplified micromachined vibratory angle measuring gyroscopes, micromachined inertial sensors and method of operation for the same |
US6952965B2 (en) * | 2002-12-24 | 2005-10-11 | Samsung Electronics Co., Ltd. | Vertical MEMS gyroscope by horizontal driving |
CN101109634A (zh) * | 2007-08-06 | 2008-01-23 | 北京航空航天大学 | 一种mems陀螺仪的精密安装基准体组件及其安装方法 |
US7549334B2 (en) * | 2006-04-24 | 2009-06-23 | Milli Sensor Systems + Actuators | Small angle bias measurement mechanism for MEMS instruments |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0663932B2 (ja) * | 1989-10-09 | 1994-08-22 | 日産自動車株式会社 | 車両状態量推定装置 |
JPH03188317A (ja) * | 1989-12-19 | 1991-08-16 | Sumitomo Electric Ind Ltd | 方位検出装置 |
JP3628046B2 (ja) * | 1994-08-31 | 2005-03-09 | 株式会社デンソー | 車両用現在位置検出装置 |
JP2000055678A (ja) * | 1998-08-04 | 2000-02-25 | Denso Corp | 車両用現在位置検出装置 |
JP3726884B2 (ja) * | 2001-04-25 | 2005-12-14 | 学校法人日本大学 | 慣性計測装置を用いた姿勢推定装置及び方法並びにプログラム |
US6934660B2 (en) | 2003-02-20 | 2005-08-23 | The Regents Of The University Of California | Multi stage control architecture for error suppression in micromachined gyroscopes |
US7040164B2 (en) * | 2003-12-04 | 2006-05-09 | The Regents Of The University Of California | Method of simultaneously and directly generating an angular position and angular velocity measurement in a micromachined gyroscope |
US7377167B2 (en) * | 2004-02-27 | 2008-05-27 | The Regents Of The University Of California | Nonresonant micromachined gyroscopes with structural mode-decoupling |
JP2006038650A (ja) * | 2004-07-27 | 2006-02-09 | Sumitomo Precision Prod Co Ltd | 姿勢計測方法、姿勢制御装置、方位計及びコンピュータプログラム |
JP5294228B2 (ja) * | 2006-09-27 | 2013-09-18 | シチズンホールディングス株式会社 | 物理量センサ |
JP5029442B2 (ja) * | 2007-08-27 | 2012-09-19 | 株式会社豊田中央研究所 | 車両姿勢角推定装置及びプログラム |
JP4576441B2 (ja) * | 2008-03-21 | 2010-11-10 | 日立オートモティブシステムズ株式会社 | 角速度センサ |
TWI337585B (en) * | 2008-10-16 | 2011-02-21 | Univ Nat Chiao Tung | Road angle estimation system and its method |
TWI405951B (zh) * | 2010-04-27 | 2013-08-21 | Univ Nat Chiao Tung | 陀螺儀控制方法 |
-
2009
- 2009-07-09 TW TW098123199A patent/TWI384198B/zh not_active IP Right Cessation
- 2009-11-03 US US12/611,268 patent/US8166817B2/en not_active Expired - Fee Related
- 2009-12-28 JP JP2009298538A patent/JP5139412B2/ja not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6481285B1 (en) * | 1999-04-21 | 2002-11-19 | Andrei M. Shkel | Micro-machined angle-measuring gyroscope |
US6928874B2 (en) * | 2002-11-15 | 2005-08-16 | The Regents Of The University Of California | Dynamically amplified micromachined vibratory angle measuring gyroscopes, micromachined inertial sensors and method of operation for the same |
US6952965B2 (en) * | 2002-12-24 | 2005-10-11 | Samsung Electronics Co., Ltd. | Vertical MEMS gyroscope by horizontal driving |
US7549334B2 (en) * | 2006-04-24 | 2009-06-23 | Milli Sensor Systems + Actuators | Small angle bias measurement mechanism for MEMS instruments |
CN101109634A (zh) * | 2007-08-06 | 2008-01-23 | 北京航空航天大学 | 一种mems陀螺仪的精密安装基准体组件及其安装方法 |
Also Published As
Publication number | Publication date |
---|---|
US8166817B2 (en) | 2012-05-01 |
TW201102616A (en) | 2011-01-16 |
US20110005315A1 (en) | 2011-01-13 |
JP5139412B2 (ja) | 2013-02-06 |
JP2011017688A (ja) | 2011-01-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TWI384198B (zh) | Angle measurement gyroscope system and angle estimation method | |
CN109323711B (zh) | 一种陀螺仪模态反转零位自校正方法及*** | |
CN111551174A (zh) | 基于多传感器惯性导航***的高动态车辆姿态计算方法及*** | |
CN110017850B (zh) | 一种陀螺仪漂移估计方法、装置及定位*** | |
CN113155114B (zh) | Mems惯性测量单元陀螺零位的温度补偿方法及装置 | |
JP6799920B2 (ja) | 原位置での(in−situ)バイアス自己校正を伴う高帯域幅のコリオリ振動ジャイロスコープ(cvg) | |
CN108731676B (zh) | 一种基于惯性导航技术的姿态融合增强测量方法及*** | |
JP6641712B2 (ja) | 回路装置、電子機器及び移動体 | |
US20190025056A1 (en) | Electrostatic offset correction | |
CN112683269B (zh) | 一种附有运动加速度补偿的marg姿态计算方法 | |
WO2002010678A1 (en) | Angular sensor and drive feedback for adjusting error | |
TWI405951B (zh) | 陀螺儀控制方法 | |
KR101658473B1 (ko) | Mems자이로스코프의 가속도 민감도 보정 방법 | |
CN110595434B (zh) | 基于mems传感器的四元数融合姿态估计方法 | |
CN111512118B (zh) | 检测质块偏移量补偿 | |
CN101144719A (zh) | 陀螺的虚拟实现方法 | |
CN110471293B (zh) | 一种估计时变角速度的z轴陀螺仪滑模控制方法 | |
RU2301970C1 (ru) | Микромеханический гироскоп вибрационного типа | |
Giacci et al. | Capacitive vs piezoresistive MEMS gyroscopes: a theoretical and experimental noise comparison | |
US11268975B2 (en) | Accelerometer sensitivity self-calibration with duty cycle control of drive signal | |
CN110579966B (zh) | 一种基于神经网络辨识参数的z轴陀螺仪控制方法 | |
CN110954103B (zh) | 基于mems传感器的车体动态姿态估计的方法及*** | |
CN112326162B (zh) | 一种机载分布式pos用机翼弹性变形测量方法 | |
US20160245651A1 (en) | Circuit device, physical quantity detection device, electronic apparatus, and moving object | |
Chi et al. | A gyroscope control system for unknown proof mass and interface circuit errors |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
MM4A | Annulment or lapse of patent due to non-payment of fees |