TW392066B - Orientation angle detector - Google Patents
Orientation angle detector Download PDFInfo
- Publication number
- TW392066B TW392066B TW088112491A TW88112491A TW392066B TW 392066 B TW392066 B TW 392066B TW 088112491 A TW088112491 A TW 088112491A TW 88112491 A TW88112491 A TW 88112491A TW 392066 B TW392066 B TW 392066B
- Authority
- TW
- Taiwan
- Prior art keywords
- angle
- experimental
- calculator
- patent application
- correction
- Prior art date
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F3/00—Input arrangements for transferring data to be processed into a form capable of being handled by the computer; Output arrangements for transferring data from processing unit to output unit, e.g. interface arrangements
- G06F3/01—Input arrangements or combined input and output arrangements for interaction between user and computer
- G06F3/011—Arrangements for interaction with the human body, e.g. for user immersion in virtual reality
- G06F3/012—Head tracking input arrangements
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
- G01C21/1654—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with electromagnetic compass
-
- G—PHYSICS
- G02—OPTICS
- G02B—OPTICAL ELEMENTS, SYSTEMS OR APPARATUS
- G02B27/00—Optical systems or apparatus not provided for by any of the groups G02B1/00 - G02B26/00, G02B30/00
- G02B27/01—Head-up displays
- G02B27/017—Head mounted
-
- G—PHYSICS
- G02—OPTICS
- G02B—OPTICAL ELEMENTS, SYSTEMS OR APPARATUS
- G02B27/00—Optical systems or apparatus not provided for by any of the groups G02B1/00 - G02B26/00, G02B30/00
- G02B27/01—Head-up displays
- G02B27/0179—Display position adjusting means not related to the information to be displayed
- G02B2027/0187—Display position adjusting means not related to the information to be displayed slaved to motion of at least a part of the body of the user, e.g. head, eye
-
- G—PHYSICS
- G02—OPTICS
- G02B—OPTICAL ELEMENTS, SYSTEMS OR APPARATUS
- G02B27/00—Optical systems or apparatus not provided for by any of the groups G02B1/00 - G02B26/00, G02B30/00
- G02B27/01—Head-up displays
- G02B2027/0192—Supplementary details
- G02B2027/0198—System for aligning or maintaining alignment of an image in a predetermined direction
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Theoretical Computer Science (AREA)
- Automation & Control Theory (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Human Computer Interaction (AREA)
- Gyroscopes (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
- Measuring Magnetic Variables (AREA)
- Navigation (AREA)
- Geophysics And Detection Of Objects (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Description
經濟部智慧財產局員工消費合作社印製 A7 B7_ 五、發明說明(') 發昔畺 發明領城 本發明係有關一種利用陀螺儀的方向角度檢測器,更 特別的是有關這種方向角度檢測器中藉由陀螺儀對量測 得方向角的補償或校正作用。 担關枝術說阻__ 於習知設計中,方向角度檢測器是用於虛擬環境中的 拾訊器追蹤程序,並利用裝設有拾訊器的顯示器(HMDs) K增大實境及遠隔操作員糸統的作用。 一種已知的三維(3-D)方向角度檢測器含有三個陀螺儀 (K下將稱為「速率陀螺儀J ),這三個陀螺儀係配置於一 個移動中物體的三個正交軸上Μ便獲得三個正交的角速 率或是速度。將這些正交的角速率積分而產生代表三個 方向角的角因子。方向角通常是由Χ-Υ-Ζ尤拉(Eular’s) 角0 = (α,/3 ,γ )加Μ表達。一種已知的方向角度檢測器 是揭示於Yamashita等人發表於National Convention Record of I.E.E. Japan, Vol.3(1997), p.p.304-305 標題為「利用三維形勢角感知器量測人類頭部的蓮動( Measurement of Human Head Motion Using a Three-Dimensional Posture Angle Sensor)」的論文中。 為了補償合併於由速率陀螺儀量測得之角速度積分内 的誤差,吾人已知且已揭示於上述文獻中的是利用並配 置在相同的三個正交軸上的三個加速計。另外一組三個 角因子是從量測得的加速度計算出來的,且是用於估計 -3- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) I I------裝--------訂---------線 { ' (請先閱讀背面之注意事項|寫本頁> A7 _B7_ 五、發明說明(> ) 並校正由速率陀螺儀量測得的。 --------------裝 i1· f (請先閱讀背面之注意事項寫本頁) 吾人通常是以光缕陀螺儀(FOGs)以及半導體加速計當 作速率陀螺儀及加速計。FOG具有絶佳的準確度但是卻 非常昂貴吾人稱為壓電式振盪陀螺儀的一種科瑞歐里 斯(Coriolis)振盪陀螺儀是因為其低成本而顯得既經濟 又有用,但是這種陀螺儀卻具有極低的準確度。 本發明的目的是提供一種具有絶佳準確度以及簡單結 構的方向角度檢測器,毋需多說的是這種方向角度檢測 器能夠以FOGs當作速率陀螺儀,但是也能夠在較之使用 FOGs不致在準確度上有太顯著的衰退下使用Coriolis振 盪陀螺儀而得到低成本的檢測器。 發明槪沭 -I線· 根據本發明得到一種如申請專利範圍第1項的方向角 度檢测器,含有:許多陀螺儀,僳依與能在檢測器上分 別定義出檢測器座標的許多正交軸(X s - Z s )平行的方式配 置且用於量測繞個別軸(X s - Z s )的角速度(J X,J y , J z ); — 經濟部智慧財產局員工消費合作社印製 蓮動角度計算器,係耦合於許多陀螺儀上而用於從角速 度(Jx,Jy,Jz)計算出蓮動角(ΔΧ,ΔΥ,ΔΖ);至少一加 速計,係依與各正交軸(Xs-Zs)中至少一軸平行的方式配 置且用於量測加速度(Ax, Ay, Az);—靜態角度計算器,偽 耦合於那些加速計上而用於從加速度(Ax, Ay)計算出靜 態角(R,P);以及一方向角度計算器,僳縝合於運動角度 計算器及靜態角度計算器上而用於將動角(△Χ,ΔΥ,ΛΖ) 積分成一已積分角度上,並從已積分角度及靜態角(R,P)計 算出一方向角U,办,y ),此方向角(α,/? )是一檢測 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 經濟部智慧財產局員工消費合作社印製 A7 B7_ 五、發明說明($ ) 器座標(Xs-Ys-Zs)與參考座標(X-Y-Z)間在包含此檢測 器之空間內的差異;其中有兩個磁強計是依與許多正交 蚰中的某兩個軸(Xs,Ys)平行的方式配置K便沿許多軸 中的某兩個軸(Xs,Ys)量測地磁分量(Mx,My),且靜態角 度計算器是耦合於瑄兩個磁強計上而用於從這些地磁分 量(Mx,My)計算出一方位,K便從此方位上產生一個量 自參考座標(X-Y-Z)的方位偏移角Φ (R,P)的額外因子。 圔忒簡厘說明 第1圖係用Μ顯示將速皋陀螺儀、加速計、Μ及地磁計 配置於根據本發明的一較佳實施例的方向角度檢測器內 的簡略圖示; 第2 _係用以顯示一個空間的3 -維參考座標與檢測器 本身自參考座標移走之後的3 -維座標之間關係的簡略圖 示; 苐3圖係用以顯示根據本發明一實施例中方向角度檢 測器的簡略方塊電路圖示; 第4圖係用以顯示第3圖方向角度檢測器中一個靜態 角度計算器的簡略方塊電路圖示; 第5圖係用Μ顯示於Η M D内使用方向角度檢測器的簡 略圖示; 第6圖係甩Μ顯示一種高通滹波校正器的簡略方塊電 路圖示,此校正器能夠用來校正第3圖方向角度檢測器 內的每一高通滤波器; 第7圖顯示的是第6圖中不同點上的信號波形; -5- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) --------------------訂--------- (請先閱讀背面之注意事項寫本頁) 經濟部智慧財產局員工消費合作社印製 A7 B7_ 五、發明說明(4 ) 第8圖係用Μ顯示一種數位式濾波裝置的簡略方塊圖 ,此滤波裝置能夠用來取代第3圖方向角度檢測器内的 每一個高通濾波器; 第9圖係用Μ顯示第8 _高通滤波器裝置内的一種無 限脈衝回應(IIR)數位式高通濾波器的簡略方塊電路圖,· 第10圖顯示的是第8圖中不同點上的信號波形; 第11A-UC圖顯示的是第8圖高通濾波器裝置在不同 條件下的輸入和輸出信號; 第12圖係用Μ顯示將速率陀螺儀、加速計、以及地磁 計配置於根據本發明另一個較佳實施例的方向角度檢測 器內的簡略圖示; 第13Α-13Β圖顯示的是一種速率陀螺儀配件的發展圖示 ,此配件能夠用於如第1-12圖所示的方向角度檢測器内; 第14圖係用Μ顯示將速率陀螺儀、加速計、以及地磁計 配置於根據本發明又一個較佳實施例的方向角度檢測器 內的簡略圖示;Μ及 第15圖係用以顯示第14圖方向角度檢測器的簡略方塊 電路圖示。 龄佳窨觖例的說明 現在參照第1-3圖,對顯示其中有關根據本發明一較佳 實施例的方向角度檢測器作說明。這個實施例方向角度 檢測器的目的是指向對三維(3-D)空間内一物件的方向進 行檢測之用。 顯示於瑄些圖中的方向角度檢測器含有第一到第二陀 -6- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) ------! — !·^^ --------訂---------I 4 (請先閱讀背面之注意事項再填寫本頁) 經濟部智慧財產局員工消費合作社印製 A7 B7_ 五、發明說明(广) 螺儀30卜30 3 ,係依與能在檢測器上分別定義出檢測器座 標的許多正交軸Xs,Ys,和Zs平行的方式配置且用於量測 繞個別軸Xs,Ys,和Zs的第一到第三角速度Jx,Jy,Jz。 蓮動角度計算器310係耦合於第一到第二陀螺儀301-303上而用於從第一到第三角速度Jx,Jy,Jz計算出運動 角(ΔΧ,ΛΥ,ΔΖ)。第一和第二加速計403和404,係依與 兩個正交軸Xs和Ys平行的方式配置且用於量測第一和第 二加速度Αχ和Ay。這些加速計是用於量測重力加速度的。 靜態角度計算器405,係耦合於第一和第二加速計403和 404上而用於從加速度Αχ和Ay計算出靜態角(R , P)。 方向角度計算器60,係耦合於運動角度計算器310及靜 態角度計算器405上而用於將動角(ΛΧ,ΛΥ,ΔΖ)積分到 一已積分角度(ΣΛΧ,ΣΛΥ,ΣΔΖ)上,並從已積分角度 及靜態角(R,P)計算出一方向角(α ,/3 ,7 )。此方向角( α,/3 ,7 )是一檢測器座標(Xs-Ys-Zs)與參考座標(Χ-Υ-Z)間在包含此檢測器之空間内的差異。 此外,第一和第二磁強計401和402是依與許多正交蚰 中的某兩個軸Xs和Ys平行的方式配置Μ便沿許多岫中的 某兩個軸Xs和Ys量測地磁分量Μ)(和My。靜態角度計算器 405是耦合於這兩個磁強計上而用於從這些地磁分量(Mx ,My)計算出一個方位,K便從此方位上產生一個量自參 考座標(X-Y-Z)的方位偏移角Φ當作靜態角(R,P)的額外 因子。 此方向角度檢測器也含有一個方向角度記憶體70係耦 -7- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 1111111!1_ ^^ ·丨—丨 I I I I 訂-丨 — 丨 —— (請先閱讀背面之注意事項寫本頁) 經濟部智慧財產局員工消費合作社印製 A7 _B7_五、發明說明(k ) 合於方向角度計算器60上而用.於儲存這個方向角(<χ , 7 )。此個方向角是表為Ζ-Υ-Ζ尤拉角,這組尤拉角是由 三個分量組成的:擺動角c(是繞Ζ軸的旋轉角,節距角 /3是繞Υ軸的!旋轉角,而滾動角7是繞X軸的旋轉角。 運動角具有三個因子:一繞X軸的X-移動角ΛΧ,—繞 Υ軸的Υ-移動角ΔΥ,—繞Ζ軸的Ζ-移動角ΔΖ。 而靜態角度計算器405會計算出試驗性的節距角Ρ、一 試驗性的滾動角R、Μ及一試驗性的擺動角Φ當作量自第 一和第二磁場檢測信號Μχ和MyM及第一和第二加速檢測 信號Αχ和Ay的方位偏移角。試驗性的節距角P、試驗性的 滾動角R、Μ及試驗性的擺動角Φ都是靜態角的因子。 此方向角度檢測器也含有一靜態角度校正定義器50, 係用於定義出靜態角(ΙΪ,Ρ,Φ)的準確度而在所定義靜態 角是準確時產生一校正信號。而方向角度計算器60會將 已積分的角度(ΣΔΧ,ΣΛΥ,ΣΛΖ)校正成這個方向角( α , /9,7 ) 0 參照第5圖,將方向角度檢測器20連同HMD100—起設 定在使用者的頭上。檢測器20和HMD100是透過一條電黷 102而連接到視訊產生器101上。從視訊產生器101將一個 視訊信號送到HMD100上。視訊產生器101會藉由方向角而 改變或調節視訊信號。因此,使用者能夠藉由移動他的 頭而進一步修正視訊。 第一到第三陀螺儀30 1 -30 3最好是具有壓電振通器的 Coriolis振盥蛇碟儀。 請 先 閱 讀 背 S) 之 注 項 |裝- 本 · 頁 訂 線 -8 - 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 經濟部智慧財產局員工消費合作社印製 A7 B7_ 五、發明說明(7 ) 第一到第三高通濾波器(H-濾波器)304-306耦合於第 一到第三C 〇 r i ο 1 i s振盪陀螺儀3 0 1 - 3 0 3上用於抵消包含 於第一到第三Coriolis振盪陀螺儀301-303之第一到第 三陀螺儀輸出J X , J y , J z内的偏移電壓而分別產生第一到 第三濾波器輸出。 將第一到第三高通漶波器3 0 4 - 3 0 6中每一個都是設計成 具有0.1赫或是更低的截止頻率。具有低截止頻率的高通 濾波器從開始到達成穩定作業條件的過程是緩慢的。所 K,第一到第三高通濾波器304-306中每一個最好都具有 可變的截止頻率。此例中,正好在用於檢測器的電源開 關切通之後將截止頻率調整得相當高Μ便訊速地將滅波 器帶到穩定的作業條件上。在作業穩定之後,吾人可Μ 將高通濾波器調整為0.1赫的低截止頻率上。 第一到第三高通濾波器304-306通常都是鼷於類比型式 的髙通濾波器。此例中,方向角度檢测器也含有耦合於 第一到第三高通漶波器304-306上的第一到第三類比/數 位轉換器307-309。第一到第三類比-對-數位U/D)轉換 器307-309會在每一取樣間隔St上對第一到第三滹波器輸 出進行取樣,而分別產生第一到第三時間-序列數位信號 。蓮動角度計算器310會接收第一到第三時間-序列數位 信號當作進來的第一到第三時間-序列數位信號而產生代 表運動角的三個時間-序列移動角信號(ΔΧ,ΛΥ,ΔΖ)。 第一到第三時間-序列移動角信號·代表著:時間-序列X-移動角△ X(t),t = n, (η-1), (η-2),.·,,1,其中 n-(n-l)=St -9- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) — — — — — — — — — — — I- · 1111111 訂— — — — — — — I- (請先閱讀背面之注意事項寫本頁) A7 _B7_ 五、發明說明(4 ) ;時間-序列Y -移動角△ Y (t);以及時間-序列Z -移動角 △ Z(t)。運動角度計算器310會根據下列方程式在t = n時 計算出)(-移動角AXU)、Y -移動角△¥(»)、以及Z -移動 角△ Ζ (η): *Δχ(η)、 y 0 taniS (n-l)sin r (n-i) tan)3 (n-l)cos 7 (n-1) 'Jx(n) ΔΥ(η) X cos r(n-l〉 -sin T (n-1) X Jy(n) ΔΖ(ΐ) 0 < -sinr (n-l}/<pos /3.(n-l) cos r (n-l)/cosiJ (n-l) / 、Jz(n), 其中/8U-1)和7 (η-1)是在t = n- l時從方向角度記憶體 70諝取到的節距角/3和滾動角7 ,Jx(n),Jy(n),和Jz(n) 是第一到第三進來的時間-序列數位信號在t = n時的第一 到第三數位信號。 使用高通濾波器使吾人能抵消包含於陀螺儀輸出内的偏 移電壓。不過,濾波器輸出會因為來自滹波器內的電容 器作用所產生的失真現象而受到破壞。為了去除這種失 真現象,方向角度檢測器最好含有三個高通漶波校正電 路3 11 ,這種高通漶波校正電路是耦合於第一到第三類比 -對-數位轉換器307 - 30 9與運動角度計算器310之間如第3 圖所示。高通濾波校正電路311會補償伴隨在第一到第三 高通濾波器上的失真現象而產生第一到第三已校正信號 。將第一到第三已校正信號送到運動角度計算器3 1 0上當 作第一到第三進來的時間-序列數位信號。 每一個高通濾波校正電路311都會執行由下列方程式給 定的計算: -10- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 請 先 閱 讀 背 面 之 注 意 事 項 再, f k 本 · 頁 訂 線 經濟部智慧財產局員工消費合作社印製 A7 B7 五、發明說明(9 J (n)=F (η) + (Δ t/RC) · Σ F(η) 其中J ( η )是對應到進來的第一到第三時間-序列數位信 號在t = n- l時的已校正信號。FU)是一個在t = n- l時對應 到第一到第三時間-序列數位信號的數位值。△ t / R C是 一個常數值。 參照第6圖,第一到第三高通滤波校正電路311中每 一個都含有一個積分器,此積分器則含有一第一叠加器 31101及一暫存器31102,係用於對相應的時間序列數位 值積分而將積分得到的數值保持於暫存器31102內。為了 產生常數值而提供一個常數值產生器31103。培增器31104 是耦合於暫存器31102和常數值產生器31103上K便將已 積分數值乘上此常數值而產生一已倍增的數值。提供一 第二曼加器 3U05 K便將已倍增的數值加到依時間-序列 進來的數位值上而產生已校正信號。 參照第7圖,其中顯示了一種用於C 〇 r i ο 1 i s振逸1¾樣 螺儀之驅動電壓的輸入波形(a)、一種輸出波形(b)、一 種高通滤波器的輸出波形(c)、一種如上所述高通滹波器 校正器311的輸出波形(d)。從(c)和(d)兩種波形可以看 請 先 閱 讀 背 之 注 意 事 項 5裝· 本· 頁 訂 線 經濟部智慧財產局員工消費合作社印製 '^圖 形 6 波第 從照 已參 ,再 出 路 電10 償31 補器 差加 誤« 移及 去 not 高1 m 1 形 波 在 琨 出 了 除 象 規 真 失 的 上 路 電 正 校 器 波 0 通 高 偏 個 一 有 含 也 10電 31償 - ij 1 補 10差 31誤 器移 分偏 積 。 由差 償誤 補移 W偏 08的 11成 -3造 算 的 器 正 校 差 誤 ο 準 位 I 勺 係β 差 6,誤 10移 31偏 器出 義義 定定 出並 輸測 一 觀 有行 含進 路時 數 常 在 持 維 號 信 正 校 已 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) A7 B7 五、發明說明(^ ) 是耦合於輸出定義器311〇6上並産生一誤差校正信號以 回應此誤差位準。將誤差校正信號供應到暫存器31102 上,此暫存器3 1 1 0 2則因此得以校正已積分數值。常數 值校正電路31108也是耦合於誤差校正器311Q7上並校正 常數值産生器31103的常數值以回應此誤差校正信號。 再參照第7圖,其中顯示的是具有偏移誤差補償電路 311D6-311Q8之髙通波濾器校正器311上的一種輸出波形 U)。比較波形(d)與波形(e)可以看出,已進一步改良了 高通波濾器校正器311的输出波形(e)* 第一到第三高通濾波器可能是第一到第三數位式高通 濂波裝置而分別産生第一到第三時間-序列數位漉波器 輸出β 經濟部智慧財產局員工消費合作社印製 參照第8圖,第一到第三數位式高通濾波裝置中每一 齒都含有一艏類比-對-數位轉換器313,係耦合於某一相 應的第一到第三陀螺儀301-303上以便在取樣間隔St上對 相應的第一到第三陀螺儀輸出進行取樣而産生一種時間 -序列數位信號β數位濂波器3 1 5是锇合於類比-對-數位 轉換器313上為時間-序列數位信號進行濾波而産生相應 的第一到第三時間-序列數位濾波器输出。蓮動角度計 算器310會接收第一到第三時間-序列數位嫌波器輸出當 作第一到第三進來的時間-序列數位信號。 第一到第三時間-序列蓮動角信號代表著:時間·序列 乂-移動角^义(1;),尤=11,(11-1),(11-2),,..1,其中11-(11-1) =S t ;時間-序列Υ -移動角△ Y (t);以及時間-序列ζ -移動 角△ Z (t) 〇 數位濾波器315的實例是一種無限脈衝回應(IIR)型式 本紙張尺度適用+國國家標準(CNS)A4規格(210 X 2^广公爱) A7 B7 五、發明說明( 的數位滤波器,如第9圖所示。此IIR數位式高通滅波 器315具有延遲緩衝值P1和P2。 數位式高通滹波裝置(第8圖)也含有一個正/負定義 器3 1 6 ,係耦合於數位濾波器3 1 5的一輸出端上Μ便於時 間-序數位信號在正或負之間變換時產生一變換信號。 延遲緩衝值重設電路3 1 7是耦合於數位漶波器3 1 5是正/ 負定義器316上。延遲緩衝值重設電路317是回應變換信 號而產生數位濾波器315的延遲緩衝值Ρ1和Ρ2。 參照第10圖,其中顯示了各種波形a-d。波形a-c是類 似於第7圖中的波形(a)-(c)而波形d上述结合第8圖和 第9圖之數位式高通漶波裝置的一種輸出波形。如波 形d所示,其中失真現象亦即因為使用類比濾波器而出 現的琨象是由虛線標示出,吾人能夠藉由使用數位式高 通濾波裝置而將之去除。第11A圖顯示了上述數位式高 通漶波裝置的輸入波形alK及輸出波形bl。從圖上可Μ 看出,其中的漂移現象並未獲致改良。 數位式高通滤波裝置(第8圖)也含有:一偏移值產生 器319Μ產生一偏移值,Μ及一耦合於偏移值產生器319 上的倍增器3 2 0。配置此倍增器3 2 0的使類比-對-數位轉 換器313與數位濾波器315連接起來。倍增器3 20是用於使 時間-序列數位信號倍增此偏移值。偏移值校正電路318 是耦合於偏移值產生器319和正/負定義器316上,且是 用Μ回應變換信號而產生偏移值。 於執行校正而將偏移值設定為正好在校正之前時間- 13- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 請 先 閱 讀 背 面 之 注 意 事 項 |裝- 尽 · 頁 訂 經濟部智慧財產局員工消費合作社印製 經濟部智慧財產局員工消費合作社印製
A7 _B7_._五、發明說明(P ) 序列數位漶波器上一數值的例子裡,數位滹波器的輸入 和輸出波形是分別顯示於第11 B圖的a 2和a 1上。 偏移偏的校正最好是根據下列方程式而執行: OS(n)=OS(n-l)-mX [OS(n-l)-D(n-l)] 其中0 S (η )和0 S U - 1)分別是校正之後和之前的偏移值, DU-1)是——來自類比-對-數位轉換器的信號,而0<mS 0 . 5。偏移值的校正改良了輸出上的漂移規象,瑄可从 從第11C圖中的輸入和輸出波形a3和b3看出。 參照第4圖,靜態角度計算器405含有耦合於第一和 第二加速計403和404上的第一和第二類比-對-數位轉換 器4050 1和40502。第一和第二類比-對-數位轉換器4050 1 和40502會在每一個取樣間隔St上對第一和第二加速計檢 测信號&)?和Ay進行取樣而產生第一和第二時間-序列數位 加速度信號。試驗性的節距角度計算器40 5 04是耦合於第 一類比-對-數位轉換器405 0 1上,且會從第一時間-序列數 位加速度信號計算出一個試驗性的節距角P。試驗性的滾 動角度計算器40503是耦合於第二類比-對-數位轉換器 40502和試驗性的節距角度計算器40504上。試驗性的滾 動角度計算器40503會從第二時間-序列數位加速度信號 Μ及試驗性的節距角P計算出一試驗性的滾動角R。 當第一和第二時間-序列數位加速度信號是表為Ax(t) 和 Ay(t) ,t = n, (n-1),(n-2) , . . . ,1,而 St = n- (n-l)時,試 驗性的節距角度計算器40 5 04和試驗性的滾動角度計算 器40 5 0 3會分別根據下列方程式計算出試驗性的節距角P 請 先 閱 讀 背 面 之 注 項 再I| k 本 . 頁 訂 ▲ 14 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) A7 B7 五、發明說明(ο ) 和試驗性的滾動角R: P(n)=sin_i Αχ(η),以及 R(n)=sin'1 [Ay(n)/cosP(n)] 其中?(11)、以11)、九\(11)、和众丫(11)代表著在1 = 11時?、1{ 、A x (t)和A y ( U的數值。 靜態角度計算器405也含有耦合於第一和第二地磁磁強 計401和402上的第三和第四類比_對-數位轉換器405D5和 4 0 5 0 6。第三和第四類比-對-數位鞞換器4 0 5 0 5和40 5 0 6會 在毎一锢取樣間隔St上對第一和第二磁場檢测信號Mx和My 進行取樣而分別産生第一和第二時間-序列數位磁場檢湖 信號。座標轉換器405D7是網合於第三和第四類比-對-數 位轉換器4050 5和40506、試驗性的滾動角度計算器40503、 以及試驗性的節鉅角度計算器4Q5D4上。座檫轉換器40507 會將第一和第二時間-序列數位磁場檢測信號轉換成第 一和第二時間序列-數位地磁分量信號,這兩個信號代表 箸參考的X-Y-Z座標上X-Y平面内對應的地磁分量Hx和Hy 。方位計算器4Q508是繙合於座樣轉換器40507上,且會從 地磁磁場分童Hx和Hy計算出一個方位角矽而産生一個試 驗性的搌動角Φ當作方位偏離角。此外,方位記億體40512 是鎘合於方位計算器4050 8上用於儲存方位角块。 靜態角度計算器405也含有锶合於第三和第四類比-對-數位轉換器40505和40506上的Z -方向磁場分量産生器40 509-40515。Z-方向磁場分量産生器40509-40515會從第 一和第二磁場檢測信號Mx和My産生一時間-序列數位Z- -15- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) -------------·!.*.— (請先閱讀背面之注意事項再*本頁) . .線- 經濟部智慧財產局員工消費合作社印製 經濟部智慧財產局員工消費合作社印製 A7 B7 五、發明說明(4 ) 方向磁場分量信號Mz、一先前量測得的地磁磁力Ht、"-由量自X-Y平面之檢測器座標之Xs和Ys軸所定義Xs-Ys平 面上的初始歪斜角0^、一量自X-Y平面之Xs-Ys平面上 的新近歪斜角。 座標轉換器40507會根據下列方程從第一和第二磁場 檢測信號Mx和My、時間-序列數位Z -方向磁場分量信號 Μ z、Μ及試驗性的節距和滾動角P和R計算出地磁磁場 分量Ηχ和Hy :
Hx(n)=cos[P(n)]X Mx(n)+sin[P(n)]x Mz(n),
Hy(n)=sin[R(n)]x sin[P(n)]x Mz(n) +cos[R(n)]X cos[P(n)]x Mz(n) 其中 Hx(n),Hy(n),Mx(n),My(n),Mz(n),P(n),R(n)代表 著在 t = n時 1^,}{3^,1^,1'{7,^12,卩,1?的數值。 方位計算器40508會根據下列方程式從Hx(n)和Hy(n) 計算出方位角必在t=n時的值角必(η): Φ (n)=-tan ^[Hy(n)/Hx(n)] 方位計算器40508也會根據下列方程式從必(n)M及一 初始的方位偏離角必(0)計算出在t = n時的試驗性擺動角 φ : Φ (η) = Φ (η) - Φ (0) Ζ-方向磁場分量產生器40509-40515含有地磁磁地產 生器(40509-40510)Μ產生地磁磁力Ht。新近Ζ -方向磁 場分量絕對值計算器40511會根據下列方程式從地磁磁 地Ht、及第一和第二時間-序列磁場檢測信號Mx和My在 -16- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) ------I---I J --------訂 *--------\ 4 (請先閱讀背面之注意事項再填寫本頁) A7 ---_-_._B7 五、發明說明(·Μ t = n時的新近數值MxU)和My (η)計算出1出方向磁場分量 對絕值丨Μζ丨: i Hz(n)| = [Ht2 - {Hx (n)2 +My (η)2 } 斩近歪斜角計算器40513是耦合於方向角度記憶體70 及方位記憶體405 1 2上而計算出近斩近的歪斜角0 。符 號定義器40 51 4是耦合於新近歪斜角計算器40513上而從 新近歪斜角02 Μ及初始歪斜角0〇為斩近Z -方向磁場 分量Μζ (η)產生一符號卜或-)。 斩近Ζ-方向磁場分量計算器40 515是耦合於新近Ζ-方 向磁場分量絕緣值計算器40 511和符號定義器40514上而 產生Ζ-方向磁場分量Μζ (η)。 經濟部智慧財產局員工消費合作社印製 .地磁磁力產生器(40509 -405 10)含有一初始地磁磁力 記憶體40509,記憶體係分別透過兩個切換元件S1,S2而 選擇性地耦合於第三和第四類比-對-數位轉換器40505 和40506上。初始地磁磁力記億體40509會由第三和第四 類比-對-數位轉換器40505和40506透過兩個切換元件S1 ,S2在初始時刻選擇性地切通而預筅記憶一初始的X -方 向、Y -方向、和Z -方向的地磁磁場分量Nx(n),My(0),和 Μ ζ (0 ) 〇 處理器40510是耦合於初始地磁磁力記憶體40509上而 根據下列方程式將初始的X-方向、Ρ方向、和ζ-方向的 地磁磁埸分量Mx(0),My(0),和Μζ(0)處理成地磁磁力Ht: I Ht I = [Mx (0)2+My (Ο)2 Λε (Ο)2 ] 1/2 因此,地磁磁力的絕對值I Ht|是記憶在初始地磁磁力 記憶體40509内。 ' -17- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 五、發明說明(* A7 B7 經濟部智慧財產局員工消費合作社印製 現在,要說明如何將初始的X -方向、Y -方向、和Z -方 向的地磁磁場分量Mx(0) ,My(0),和Μζ(0)儲存於初始地磁 磁力記憶體40509M内。 在初始狀態下,一方面將方向角度檢測器定位成使第 一和第二地磁磁強計401和402中特殊的一個是平行於參 考座標的Z軸。然後,切通兩個切換元件S1,S2中相應的 一個Μ便將由這個特殊的地磁磁強計(401或402)檢測得 的地磁磁塲分量記憶在初始地磁磁力記憶體40509內當作 初始的Ζ -方向地磁磁場分量ΜΖ(0)。之後,另一方面將 方向角度檢測器定位成使第一和第二地磁磁強計401和 402分別平行於參考座標的X和Υ軸。然後,切通兩個切 換元件S1,S2。结果,將由第一和第二地磁磁強計401和 402檢測得的地磁磁場分量記憶於初始地磁磁力記憶體 40509內當作初始的X -方向地磁磁場分量M)c(O)和初始的 Υ-方向地磁磁場分量My (0)。 新近歪斜角計算器40 513會根據下列方程式從在t=n-l 是自方位記憶體40512謓出其角度數值為0 (n-1)的方位 角必Μ及自方向角度記億體70謓出其角度數值為/3 (n-1) 和7 (η - 1 )的滾動角和節距角召和7而計算出新近的歪 斜角Θ 2 : Θ 2 = sin_l[aa/aa2 + cc2) 1/2] "1 8 _ 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐)
請 先 閲 讀 背 S} 之 注 意|ri 頁I 訂 ▲ 經濟部智慧財產局員工消費合作社印製 A7 _B7_五、發明說明(’7 ) 符號定義器40514 —方面會在新近歪斜角大於初 始歪斜角時將符號定義成正( + ),而另一方面會在新 近歪斜角等於或小於初始歪斜角0 〇但是大於_90 度角時將符號定義成負(_)。 回到第3画,方向角度檢測器也含有一耦合於靜態角 計算器405和方向角度計算器60上的靜態角度校正定義 器50。靜態角度校正定義器50是用於靜態角(P,R,0)的 定義準確度Μ產生校正信號。而方向角度計算器60是用以 回應校正信號而計算出一校正數值。然後,方向角度計 算器60會藉由校正數值校正一組已積分數值而產生一組 已修正數值。將這組已修正數值當作方向角(α, /3 ,7 ) 傳遞出去。 方向角度計算器60會根據下列方程式計算出第一到第 三已積分數值ΣΛΧ,ΣΔΥ,和ΣΛΖ: Σ Δ X (η) = 7 (η-1) +Δ X (η) Σ △ Υ ( η ) =/3 ( η - 1 ) + △ Υ ( n ) Σ △ Ζ (η) = α (η-1 ) +△ Ζ (η) 其中△XUhAYU),和ΛΖ(η)分別是在t = n時刻的X -移 動角ΛΧ、ΛΥ-移動角△¥、和Z-移動角ΛΖ,而7 (n-1), /3 ( η - 1 ),和a ( η - 1 )分別是在t = η - 1時刻的滾動角7 、節 距角 /3 、和擺動角 α 。而 7 (n-l),/8 (η-1),和 〇ί (η-1) 都是從方向角度記憶體70謓出來的。 當方向角度計算器60接收到校正信號,方向角度計算 器60會藉由下列方程式計算出第一到第三角誤差Ex, Ey, 請 先 閱 讀 背 之 注 意 事 項 賣 訂 線 19- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 經濟部智慧財產局員工消費合作社印製 A7 _B7_ 五、發明說明 E E : ΕΧ= Σ Δ X (n) -R (η) ΕΥ= Σ Δ Υ (η) -Ρ (η) ΕΖ= Σ Δ Ζ (η) -Φ (η) 然後,方向角度計算器60會從第一到第三角誤差Εχ, Ey,和Εζ決定出第一到第三校正數值Cl,C2,和C3當作校 正數值,並根據下列方程式計算出第一到第三已修正數 值當作滾動角7 、節距角/3和擺動角〇t: 7 = Σ Δ X (n) -C1 /3 = Σ Δ Y (n) -C2 α=ΣΔΖ(η)-03 於這種連接方式中,能夠分別將數值Cl,C2和C3選擇成 小於第一到第三角誤差E X , E y ,和E Z。可替代地,能夠分 別由kix Ex,k2x Ey,和k3X Εζ決定出數值C1,C2,和C3,其 中k 1,k 2 ,和k 3都是小於1的常數。 最好能夠於方向角度檢測器上提供一如圖所示的校正 係數產生器80。校正係數產生器80都耦合於靜態角度計 算器405和方向角度計算器60上,且會產生一組第一到第 三係數ml,m2,m3。第一到第三係數ml,m2,和m3是選自一 組預定的不同數值K回應從靜態角度計算器405接收到 的試驗性節距P和試驗性滾動角R角數值。 較佳地,校正係數產生器80具有一個如以下表1所示 的表格。這個表格内具有的各組第一到第三係收π· 1 , m2, 和m 3係預先決定Μ對應到各試驗性節距P和試驗性滾動 -20- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) -. '袭--------訂---------線 (請先閱讀背面之注意事項再5W本頁) _B7_ 五、發明說明(β ) 角R的角數值。 一般而言,對極大的各試驗性節距P和試驗性滾動角R 角數值而言所決定出的第一到第三係數ml,m2和m3是相 當低的。 表1 R (deg) 0-60 60-70 70-90 m 1 : 1 ml : 0 . 7 m 1 : 0 · 3 0-60 m2 : 1 m2 : 1 m2 : 1 P (deg) m 3 : 1 m 3 · 0 . 7 m 3 : 0 · 3 m 1 : 1 ml : 0 . 7 m 1 : 0 · 3 60-70 m 2 : 0 . 7 m2 : 0 . 7 m2 : 0 . 7 m3 : 0 . 7 m 3 * 0 . 7 m 3 : 0 . 3 m 1 * 1 ml : 0 . 7 m 1 : 0 . 3 70-90 m 2 : 0 . 3 m2 : 0 . 3 m 2 : 0 ♦ 3 m 3 : 0 · 3 m 3 : 0 . 3 m3 : 0 . 3 經濟部智慧財產局員工消費合作社印製 方向角計算器6 0是Μ回應一組第一到第三係數m 1 , m 2 , 和m 3而藉由分別乘上第一到第三係數m 1 , m 2 ,和m 3 K修正 -21 - 本紙張尺度適用中國國家標準(CNS)A4規格(210 x 297公釐) A7 B7_ 五、發明說明(/ ) 第一到第三校正數值C1,C2,和C3。 現在,將對有關校正定義器50的细節作說明。校正定 義器50上提供有一靜態角度記億體50 ljl用於儲存於靜 態角度計算器40 5接收到的試驗性節距P和試驗性滚動 角R。校正定義器5 0會比較在時刻t = η接收到的試驗性節 距Ρ (η )和試驗性滾動角R (η )與稍早在時刻t = η - 1從靜態 角度記憶體501上讓出的試驗性節距P(n-l)和試驗性滾 動角 R(n-l),並分別在滿足以下的方程式(1)和(2)時將 試驗性節距角 P(n)和試驗性滾動角R(n)定義成準確的: R(n)-R (n-1 ) -B与 0 (1) Ρ (η ) -P (n-1 ) -D_0 (2) 其中B和D是選為正的數值。 於某一實例中,B和D是預定成一個幾乎等於零(0)亦 即校正定義器50内先前所具有的極小數值。 於另一實例中,校正定義器50是連接到運動角度計算 器310上且會接收來自其上的X -移動角Λ)((η)和Y -移動 角△¥(〇)。而將Β和D分別選為X-移動角AXU)和Υ-移動 角△ Υ (η )。 此外,能夠令校正定義器50定義出試驗性擺動角Φ的 準確度。校正定義器50會分別從靜態角度計算器40 5和 運動角度計算器310接收試驗性擺動角Φ (t)和Ζ-移動角 △ Z (t)。試驗性擺動角Φ (t)是儲存於靜態角度計算器 405內。校正定義器50會根據Μ下的方程式(3)在時刻t = -22- 本紙張尺度適用中國國家標準(CNS)A4規格(2]〇χ 297公釐) (請先閱讀背面之注意事項再填寫本頁) . -線_ 經濟部智慧財產局員工消費合作社印製 A7 _B7_ 五、發明說明(—) η處理試驗性擺動角Φ ( η )和Z -移動角△ Z ( η )且在時刻t = η -]處理自靜態角度記憶體5 0 1讀取到的擺動角Φ ( η - 1 ): (請先閱讀背面之注意事項再^寫本頁) | Φ (η)-Φ (η-1) I -ΔΖ(η)^0 (3) 當滿足方程式(3)時校正定義器50會將試驗性擺動角Φ (η)定義成是準確的。 於校正定義器50中,吾人能夠利用運動角的移動平均 值而定義出靜態角。 校正角度定義器50會於靜態角度記憶體501内儲存從 運動角度計算器310接收到的X-移動角△ X、Υ-移動角△ Υ和Ζ-移動角ΛΖ,Μ及從靜態角度計算器405接收到的試 驗性節距角Ρ(η)、試驗性滾動角(RU)、和試驗性擺動角 Φ (η)。校正定義器50會計算出試驗性節距角P(t)變化的 移動平均值、試驗性滾動角R(t)變化的移動平均值、試 驗性擺動角Φ (t)變化的移動平均值、X -移動角ΛΧ(ΐ) 經濟部智慧財產局員工消費合作社印制衣
的移動平均值、Υ -移動角△ Y( t)的移動平均值、以及Ζ -移動角AZ(t)的移動平均值。然後,校正定義器50會根 據Μ下的方程式(4) , (5 )和(6 )將試驗性節距角P (η )、試 驗性滾動角 R(n)、試驗性擺動角Φ (η)定義成是準確的: [R ( η ) - R ( η - 1))/ C -[Δ Χ(η)+Δ Χ(η-1) + ...+Δ X(n-C + 1)]/C% 0 (4)
[Ρ (η) - Ρ (η-1 ))/C -[Δ Υ(η)+Δ Υ(η-1) + ...+Δ Y(n-C + 1)]/C^ 0 (5) Μ及 本紙張尺度適用中國國家標準(CNS)A4規格(2]〇χ 297公釐) 經濟部智慧財產局員工消費合作社印製 A7 _B7_五、發明說明(广) [Φ (η ) - Φ in -1 )J/C -[Δ Ζ(η)+Δ Ζ(η-1) + ...+Δ Z(n-C + 1)]/C^ Ο (6) 定義了靜態角的结果,校正定義器50會於試驗性節距 角(Ρ(η)與試驗性滾動角R(n)中至少有一個是定義成準確 時產生校正信號,且校正定義器50會於試驗性節距角P(n) 與試驗性滾動角R(n)中沒有任何一個是定義成準確的時 候產生非-校正信號。為了回應非-校正信號,方向角度 計算器60將會產生一組已積分數值ΣΛΧ(η)、ΣΛΥ(η) 、ΣΔΖ(η)當作方向角(cx,/S,7)。 於執行對試驗性擺動角Φ (η)準確度的定義程序中,校 正定義器50也會於試驗性擺動角Φ (η)是定義成準確但 甚與試驗性節距角Ρ(η)和試驗性滾動角RU)是否定義成 準確無關時產生校正信號。當試驗性節距角 Ρ(η)、試 驗性滾動角R (η)、和試驗性擺動角Φ (η)中沒有任何一 個是定義成準確的時候,校正定義器50會產生非-校正信 號。 落在不同的符號範園內時,校正定義器50會在碰到某 些特殊的試驗性滾動角R、試驗性節距角Ρ、和試驗性擺 動角Φ是定義成準確的情況時,能夠產生代表著那些特 殊的試驗性滾動角R、試驗性節距角Ρ、和試驗性擺動角 Φ是定義成準確的一種標示信號當作校正信號。為了回 應此標示信號,方向角度計算器60會藉由使用試驗性滾 動角R、試驗性節距角Ρ、和試驗性擺動角ΦΜ修正對應 到那些特殊試驗性滾動角R、試驗性節距角Ρ、和試驗性 (請先閱讀背面之注意事項再填寫本頁) // . '袭 .線· 本紙張尺度適用中國國家標準(CNS)A4規格(210 x 297公t ) A7 _B7_ 五、發明說明(4 ) 擺動角φ的一些特定的第一到第三已積分數值ΣΔΧ(η) 、ΣΛΥ(η)、和ΣΔΖ(η),而產生特定的校正數值。然 後,方向角度計算器6 0會分別傳遞這些特定的已修正數 值當作特定的滾動角7 、節距角点、和擺動角α亦即分 別對應到那些特定的的第一到第三已積分數值Σ △ X ( η ) 、ΣΛΥ(η)、和ΣΛΖ(η)。方向角度計算器60會傳遞除 了那些特定的第一到第三已積分數值ΣΔΧ(η)、ΣΔΥ (η)、和ΣΔΖ(η)之外剩餘的其他已積分數值當作除了 那些特定的滾動角7 、節距角/?、和擺動角α之外剩餘 的其他角度。 參照第12圖,根據本發明另一個實施例的方向角度檢 測器會利用將第三加速計4 0 6配置成與檢測器的Z s -軸平 行而產生第三加速度檢測信號Αζ。此實施例中,靜態角 度計算器405也含有一個額外的類比-對-數位轉換器406 1 ,如第4圖中虛線所示。 額外的類比-對-數位轉換器4061是耦合於第三加速計 406上並在每一個取樣間隔St上對第三加速度檢測信號 Az進行取樣而產生一第三時間-序列數位加速度信號。 另外將第三時間-序列數位加速度信號用在滾動角度計算 器40503M計算出試驗性的滾動角R。 第一、第二、和第三時間-序列數位加速度信號是表為
Ax(t),Ay(t),和 Az(t),其中 t = n, U-l),(n-2).....1,而
St = n- (n-l),試驗性滾動角度計算器40503會分別根據下 列方程式計算出試驗性的滾動角R : -25- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 請 先 閱 讀 背 之 注 意 事 項 再 it. r ! f1 ^ 本 · 頁 訂 經濟部智慧財產局員工消費合作社印製 經濟部智慧財產局員工消費合作社印製 A7 _B7_ 五、發明說明(μ ) 當Αζ>0時, R (0)=8111^Ay (n)/cosP (η)] 當Αζ<0且Αχ>0時, R(n) = n - s ί n'[ Ay ( η ) / c o s Ρ (η)] 當Az<0且Ax<0時 R(n)=-^ -siri'[Ay(n)/cosPfn)] 其中 P(n),R(n),Ay(n),和 Az(n)代表著 t = n時的 P,R,Ay(t) ,和 A z (t) 0 於本實施例中,靜態角度校正定義器50會接收如第3和 第4圖中虛線所示的第一、第二、和第三加速度檢測信 號(Ax, Ay, Az)。從第一、第二、和第三加速度檢測信號 (Ax,Ay,Az),校正定義器50會根據下列方程式計算出一個 由Xs -軸方向、Ys -軸方向、和Zs -軸方向之加速度構成的 合成加速度向量: 1/2 | A I = (Ax + Ay + Az) 校正定義器50會在I Al =1G時產生校正信‘號,其中G是 重力加速度。 本發明的另一概念會提供一種包含Coriolis振盪陀螺 儀的電路配件,此種配件使吾人能利用C 〇 r i ο 1 i s振盪陀 螺儀簡化方向角度檢測器的裝配。 參照第1 3 A和1 3 B圖,分別將第一到第三陀螺儀3 0 1 - 3 0 3 上的三個壓電陶瓷振盪器固定地裝設於彈性印刷電路板 201的三個區段上。如第11B圖所示,將彈性印刷電路板 201彎折Μ形成一個呈直角的圓柱,亦即具有互為垂直 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) —裝--------訂---------線 i (請先閱讀背面之注意事項再填寫本頁) 五、發明說明(/) A7 B7 經濟部智慧財產局員工消費合作社印製 的第一和第二側板區段Μ及一個第三側板區段而形成一 個呈直角的圓柱體。彈性印刷電路板201在彎折部分具有 兩個狹鏠2 0 2和2 0 3 Μ利彎折作業。 在將第一到第三壓電陶瓷振盪器301-303裝設於彈性印 刷電路板201上之後,將彈性印刷電路板201彎折Κ形以 一個圼矩形的圓柱。然後,依平行於檢測器座標之Xs:Xs 軸、Ys -軸、Zs -軸的方式自動地配置第一到第三陀螺儀 301,302,和303上的三個壓電陶瓷振盪器。 彈性印刷電路板201上具有一個直角圓柱體的端點邊 緣會在單一平面上延伸Μ及從該端點邊緣延伸出來的一 些端子204。這些端子204是與外部電氣零件作電氣連接 用的。第三側板區段會沿與端點邊緣相反的方向延伸到 超過第一和第二側板區段,使得吾人能可靠地將Ζ -軸上 的第三陀螺儀3 0 3裝設於强性印刷電路板2 0 1上。 甩Μ取代單一的彈性印刷電路板2 0 1,吾人能夠分別 將三個印刷電路板用於第一到第三側板部分。 於根據本發明的方向角度檢測器中所用C 〇 r ί ο 1 i s振盪 陀螺儀内,吾人能夠使用任何一種型式的壓電振邇器但 是最好是由例如壓電陶瓷、壓電單晶材料、Μ及矽等製 成的非-磁性壓電材料。 於方向角度檢測器的某些應用中,只需要用到方向角 中的兩個因子(例如節距角和擺動角)而不需要用到其他 因子(滾動角)。本發明的另一個實施例是指向一種用於 這類應用中的二維(2 - D )方向角度檢測器。 27 本紙張尺度適用中國國家標準(CNS)A4規格(210 x 297公釐) 請 先 間 讀 背 S 之 注 意 事 項 賣 訂 線 經濟部智慧財產局員工消費合作社印製 A7 B7_ 五、發明說明(4 ) 參照第14圖和第15圖,除了省略三個陀螺儀之一 Μ及 伴隨其上的零件和功能之外,其中顯示的2-D方向角度 檢測器是類似如第1-12圖所示的3-D方向角度檢測器。 類似的各零件是表為帶有或是沒有(’)的相同參考符號。 2-D方向角度檢測器只會傳遞擺動角ct和節距角/9當 作2-D的方向角。如第14圖所示,依平行於Xs -軸和Ys-軸的方式配置第一和第二陀螺儀302和303。第一和第二 陀螺儀3 0 2和3 0 3分別是對應到第1圖中的第二和第三陀 螺儀302和303而用於量測第一和第二角度速Jy和Jz。 運動角度計算器310'會從第一和第二角度Jy和Jz計算 出一繞Y軸的Y-軸動角ΛΥ和一繞Z軸的Z-移動角ΛΖ當作 移動角的兩個因子。 如第14圖所示而類似於第1圖的,第一和第二地磁磁 強計4 0 1和4 0 2分別是依平行於X s -軸和Y s -軸的方式配置 而用於產生第一和第二磁場檢測信號(MX,My),而第三地 磁磁強計403是依平行於Xs -軸的方式配置而用於產生一 個加速度檢測信號(Αχ)。靜態角度計算器405’會從第一 和第二磁場檢測信號(Μ X , M y ) Μ及加速度檢測信號(A X ) 計算出試驗性節距角P和試驗性擺動角Φ當作方位偏離 角。 方向角度計算器60’會藉由將Υ-移動角ΛΥ和Ζ-移動角 △ Ζ對時間積分而計算出一組由第一和第二已積分數值 (ΣΛΥ,ΣΛΖ)構成的已積分數值,且由這組已積分數 值(ΣΛΥ,ΣΔΖ)及靜態角產生2-D的方向角(cx ,/S ), 並將2 - D的方向角儲存於方向角度記億體7 0内。 _ 2 8 _ 本紙張尺度適用中國國家標準(CNS)A4規格(210 x 297公釐) I f--------^---------^ I > - (請先閱讀背面之注意事項再填寫本頁) A7 B7 五、發明說明( 於第一和第二陀螺儀302和303與蓮動角度計算器310’ 之間,存在有第一和第二高通漶波器305和306係因為與 第3圖中第二和第三高通滹波器類似的目的而設置的。 雖然為求簡化圖表而未作標示,毋需說明的是在高通滤 波器的輸出側上利用第一和第二A/D轉換器對信號進行 數位處理。 吾人能夠將第6圖中的高通滹波校正器311用於本實施 例中,且能夠以第8圖中的數位式高通濾波器取代高通 濾波器305和306。吾人為求簡化說明的目的而省略了對 高通濾波器、A/D轉換器、K及數位式A/D轉換器的說明。 接收了代表著時間-序列Y -移動角△ Y,t = n , ( η - 1) , ( η - 2 ) ,...,1,其中n(n-l)=StM及時間-序列Ζ -移動角ΔΖ的各 時間-序列移動角信號之後,運動角度計算器3 1 0 ’會根據 下列方程式計算出t = n時的Υ -移動角ΛΥ和Ζ -移動角ΛΖ: 請 先 閱 讀 背 面 之 注 意 事 項 再. m 5裝、 本 . 頁 訂
ΔΥ(η iA2(n)J Ο Ο 1/cos β (η-1)
Jy(n) Jz (π) 線 經濟部智慧財產局員工消費合作社印製 根據本實施例的2-D方向角度檢測器含有第一和第二震 盪去除器321和322而用於去除因為檢測器本身肇因於例如 使用者雙手無意振動而包含於第一和第二陀螺儀輸出(Jy ,J 2 )內的震盪。 第一和第二震盪去除器321和322會分別使第一和第二 高通漶波器305和306與運動角度計算器310’連接。第一 和第二震盪去除器321和322會進行處理而分別在跨越某 29- 本纸張尺度適用中國國家標準(CNS)/V1規格(2]0 X 297公釐) 五、發明說明(>, A7 B7 第 3 取器 出除 輸去 器盪 波震 濾二 二第 第和 和一 1 第 第 , 對後 内然 期 0 週均 間平 時間 定時 預二 一 第 第 和 和 限值 臨限 定臨 預定 二預 第二 和第 一 和 第一 與第 均於 平小 間均 時平 二間去 第時盪 和二震 一 第二 第和第 較一和 比第一 別於第 分 〇 , 會值時 除 去 地 時 暫 別 分 會 2 2 3 和 1A 2 3 器 除 已斗 二度 第角 和 1 I 遵 第到 生應 産供 並號 分信 剖理 些處 某己 的二 出第 輸和 器一 波第 濾將 二 。 第號 和信 一 理 第處 為 表 號 信 的 行 進 。將 號是 信 , 來内 進22 ▲ 3 二 η 第If 和32 一 器 第除 作去 當盪 上震 10'-3 每 器於 算 的 時 限 臨 其 且 {號 器信 除來 去進 盪的 震訊 ,噪 有 具 出 義 定 時 式 公 列 下 足 滿 是 a 中時 其上 --------------^—— i (請先閱讀背面之注意事項再_寫本頁)
Jin 為— { I 具 J £ 在 會 平 算 計 要 將 定 決 於 用 個 將 常 通 ο 巨 數 的 隔 間 間 為 選 值 a % ^ / 數 的 時 之 期後 週然 wy 展 說回 是以 就號 也信 ,出 理輸 處的 0)值 /IV 數 零)1 作(0 當零 η)表 /IV J 代 號一 信出 行遞 進傳 將會 會器 器除 除去 去盪 盪揉 器 換 轉 位 數 / 。比 η)類 J(有 號具 信不 進了 來除 應 驗 試 到 得 於 用 是 或 線· 經濟部智慧財產局員工消費合作社印製 器靜 算的 計 中 度圖 角 4 動第 滾於 的似 R 類 4 角是第 動 5 合 滾40聯 性器 , 參 該 應 明 說 的 圖 角 態 靜 外 之 5 器 40算 器計 算度 計角 度態 角靜 態對 照 算 計以 度所 的 明 説 器 義 定 正 校 度 角 態 靜 1 有 具 也 器 測 檢 度 角 向 方 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) A7 B7_ 五、發明說明(θ ) Μ便在試驗性節距角P和試驗性擺動角Φ是準確的時候 將一個校正信號傳遞到方向角度計算器60’上。 定義作業是類W於第4圖中校正定義器50的定義作業 但是未對試驗性滾動角R作出定義。吾人能夠根據上述 方程式(5)和(6)執行此定義作業。 此外,方向角度計算器60’只計算了兩個因子(oc, /9) 。據此,除了未對滾動角7進行處理之外,方向角回應 來自校正定義器之校正信號的校正作業是類似於第3圖 中方向角度計算器60的校正作業。所Μ,吾人為簡化說 明的目的將會省略了對方向角度計算器60’的說明。 工業應用 根據本發明,能夠得到一種其结構既小又簡單、其準 確度絕佳、且成本極低的方向角度檢測器。吾人能夠使 用這種方向角度檢測器當作HMD內的檢測器,當作用於各 種移動物體上各種測試機器的檢測器,或是當作用於電 腦、資料處理器、以及電腦遊戲機等的輸入端子。 ----------------------訂--------- (請先閱讀背面之注意事項寫本頁) 經濟部智慧財產局員工消費合作社印製 -31 - 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) A7 B7 五、發明說明(W ) 符號之說明 20.......方向角度檢測器 (請先閱讀背面之注意事項再填寫本頁) 30.......運動角度檢測器 40.......靜態角度檢測器 50,50'...靜態角度校正定義器 60,60’...方向角度計算器 7 0.......方向角度記憶體 80.......校正係數產生器 100 ......裝設有拾訊器的顯示器 101 ......視訊產生器 102 ......電纜 201......彈性印刷電路板 202,203..狹縫 2 0 4 ......端子 301 ......第一陀螺儀 302 ......第二陀螺儀 3 0 3 ......第三陀螺儀 304 ......第一高通濾波器 3 0 5 ......第二高速濾波器 經濟部智慧財產局員工消費合作社印製 30 6 ......第三高通漶波器 307 ......第一類比/數位轉換器 308 ......第二類比/數位轉換器 3 0 9 ......第三類比/數位轉換器 310,310'運動角度計算器 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) A7 _B7_ 五、發明說明() 311......高通滤波校正電路 31101.31105.. .叠加器 31102 ....暫存器 31103 ____常數值產生器 31104.. ..倍增器 31106.. ..輸出定義器 31107....誤差校正器 31 108 ....常數值校正器 313......類比/数位轉換器 315 ......無限脈衝回應(IIR)數位式高通滹波器 316 ......正/負(P/N)逆轉定義器 317 ......延遲緩衝值重設電路 318 ......偏移值校正電路 319 ......偏移值產生器 320 ......倍增器 32 1 , 322 ..震盪去除器 401 ......第一地磁磁強計 402 ......第二地磁磁強計 經濟部智慧財產局員工消費合作社印製 403 ......第一加速計 404 ......第二加速計 405 , 405 靜態角度計算器 4050 1 ____第一類比/數位轉換器 4050 2 ____第二類比/數位轉換器 40503 ____試驗性的滾動角度計算器 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) A7 _B7_ 五、發明說明(V) 40 504 ____試驗性的節距角度計算器 40 505 ____第三類比/數位轉換器 40506 ____第四類比/数位轉換器 40507 ....座標轉換器 40508.. ..方位計算器 40509.. ..初始地磁磁力記憶體 40510.. ..處理器 40511. ...Mz絕緣值計算器 405 1 2 ....方位記憶體 4051 3 ____新近歪斜角計算器 40514.. ..符號定義器 40515.. ..新近Z -方向磁場分量計算器 40 6 ......第三加速計 406 1 .....額外的類比-對-數位轉換器 501......靜態角度記憶體 ------------^ t --------訂--------- 1 、 (請先閱讀背面之注意事項再iM寫本頁> 經濟部智慧財產局員工消費合作社印製 -34- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐)
Claims (1)
- 六、申請專利範圍 請 先 閱 讀 背 Φ 之 注 意 事 項 再/ ff 本 頁 1. 一種方向角度檢測器,包含:許多陀螺儀(301-303), 係依與能在檢測器上分別定義出檢測器座標的許多正 交軸(Xs-Zs)平行的方式配置且用於量測繞個別軸(Xs Zs)的角速度(J)c,Jy,Jz); —運動角度計算器(310),係 耦合於該許多陀螺儀(30卜303)上而用於從角速度(Jx, Jy,Jz)計算出運動角(ΔΧ,ΔΥ,ΔΖ);至少一加速計(403 ,404),係依與該正交軸(Xs-Zs)中至少一袖平行的方 式配置且用於量測加速度(Ax, Ay,Az); —靜態角度計 算器(4 0 5 ),係耦合於該加速計(4 0 3 , 4 0 4 )上而用於從加 速度(AX,Ay)計算出靜準角U,P);K及一方向角度計算 器(60),係耦合於該運動角度計算器(310)及該靜態角 經濟部智慧財產局員工消費合作社印製 度計算器(405)上而用於將動角(ΛΧ,ΔΥ,ΔΖ)積分到 一已積分角度上,並從該已積分角度及該靜態角(R,P) 計算出一個方向角(a ,y3,7 ),該方向角(ot,/3 ,7 )是 一檢測器座標(Xs-Ys-Zs)與參考座標(X-Y-Z)間於包含 該檢測器之空間內的差異;其中有兩磁強計是依與該 許多正交軸中的某兩軸(Xs,Ys)平行的方式配置Μ便沿 許多軸中的某兩個軸(Xs,Ys)量測地磁分量(Mx,My),且 靜態角度計算器(405)是耦合於該兩個磁強計(401,402) 上而用於從這些地磁分量(Mx,My)計算出一方位,K便 從該方位上產生一量自參考座標(X-Y-Z)的方位偏移角 Φ當作靜態(R , P )角的額外因子。 2. 如申請專利範圍第1項之方向角度檢測器,尚含有一 方向角度記憶體(70)是耦合於方向角度計算器(60)上 -35 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) A8 B8 C8 D8 六、申請專利範圍 (請先閱讀背面之注意事項再填寫本頁) 經濟部智慧財產局員工消費合作社印製 而用於儲存該方向角(α , /9 ,7 ),其中該參考座標是一 種具有一垂直的Ζ軸及兩個水平的X軸和Υ軸的三維 座標,而該檢測器座標是另一種具有分別對應到該Ζ 軸、X軸、和Υ軸之Zs軸、Xs·軸、和is軸的三維座標, 該方向角是表為由三個分童亦時繞Z軸的旋轉角(擺 動角α),繞Y軸的旋轉角(節距角及繞X軸的旋 轉角(滾動角γ )組成的Z-Y-X尤拉角,且其中該第一 到第三陀螺儀(30卜303)是依與該正交軸Xs,Ys和Zs平 行的方式配置且分別用於量測繞該Xs,Ys,和Zs軸的第 一到第三角速度(Jx,Jy,Jz),該蓮動角度計算器(310) 會從第一到第三角速度(Jx,Jy,Jz)計算出一個繞X軸 的X -移動角ΔΧ, —個繞Y铀的卜移動角△¥,一個繞Z 軸的Z -移動角ΔΖ當作該運動角的三個因子,且其中該 兩個地磁磁強計第一和第二磁強計(401,402)是依與Xs 和Ys軸平行的方式配置而分別產生第一和第二磁場檢 測信號(Mx,My),且該第一和第二加速計(403,404)中 至少有一個加速計是依與Xs和Ys蚰平行的方式配置而 產生第一和第二加速度(Ax,Ay),該靜態角度計算器( 405)會從第一和第二磁場檢測信號(Mx,My)K及第一 和第二加速度(Ax,Ay)計算出一個實驗性節距角P、一 個實驗性滾動角R、和一實驗性擺動角Φ當作該方位 偏離角,該實驗> 節距角P、該實驗性滾動角R、和該 實驗性擺動角Φ都是該靜態角的因子,且其中該方向 角度計算器(60)會藉由對X-移動角ΛΧ,Υ-移動角ΛΥ、 -36 - 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) A8 B8 C8 D8 六、申請專利範圍 和z -移動角△ z進行時間積分而計算出一組第一到第三 已積分數值(ΣΔΧ,ΣΛΥ,ΣΛΖ)並從該組已積分數值 (ΣΛΧ,ΣΛΥ,ΣΛΖ)和該靜態角產生該方向角,而將 ,該方向角儲存於該方向角度記憶體(7 0 )內。 Υ/.如申請專利範圍第2項之方向角度檢測器,其中該第一 到第三陀螺儀(30卜303)具有壓電振盪器的Coriolis振 盪陀螺儀,該第一到第三陀螺儀(3 0 1 - 3 0 3 )會產生代表 著繞該Xs,Ys,和Zs軸之角速度的第一到第三陀螺儀輸 出(Jx,Jy,Jz)。 4. 如申請專利範圍第3項之方向角度檢測器,尚含有第 一到第三高通濾波器(304-306)是耦合於第一到第三 Coriolis振盪陀螺儀(30 1 - 3 0 3 )上用於抵消包含於第 一到第三C 〇 r i ο 1 i s振憑陀螺儀(3 0 1 - 3 0 3 )之第一到第 三陀蟋儀輸出(Jx,Jy,Jz)內的偏移電壓而分別產生第 一到第三漶波器輸出。 5. 如申請專利範園第4項之方向角度檢測器,其中該第 一到第三高通漶波器(304-306).中每一都具有0.1赫或 是更低的截止頻率。 6 .如申請專利範圍第4項之方向角度檢測器,其中該第 一到第三髙通濾波器(3 0 4 - 3 0 6 )中每一都具有可變的截 止頻率。 7.如申請專利範圍第4項之方向角度檢測器,其中該第 一到第三高通漶波器(3 0 4 - 3 0 6 )是鼷於類比型式的高通 濾波器,且該方向角度檢測器也含有耦合於第一到第 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 1\ V -------------^ --- (請先閲讀背面之注意事項再<寫本頁) -線- 經濟部智慧財產局員工消費合作社印製 經濟部智慧財產局員工消費合作社印製 A8 B8 C8 D8 六、申請專利範圍 三高通濾波器(304-306)上的第一到第三類比-對-數 位轉換器(307-309)會在每一個取樣間隔St上對第一 到第三濾波器輸出進行取樣,而分別產生第一到第三 時間- '序列數位信號,該運動角度計算器310會接收 第一到第三時間-序列數位信號當作進來的第一到第 三時間-序列數位信號而產生代表該運動角的三個時 間-序列移動角信號(△Χ,ΛΥ,ΛΖ),該方向角度記憶 體(70)係耦合於方向角度計算器(60)上而用於儲存依 時間-序列從該方向角度計算器(60)傳遞過來的該方 向角。 8.如申請專利範圍第7項之方向角度檢測器,其中該第 一到第三時間-序列移動角信號代表著時間-序列X -移 動角△ X(t),t = n,(n-1),(n-2) ,...,1,其中 n(n-l)=St 、時間-序列Y -移動角△ Y (t)、Μ及時間-序列Z -移動 角△ Z (t),該蓮動角度計算器(3 1 0 )會根據下列方程式 在t = n時計算出X-移動角Z^XU)、Y-移動角ΛΥ(η)、K 及Ζ-移動角△ Ζ (η); Δχ(η)' ro tan 这(n-1 }sln 7 (η·1) tan β (n-l) cos 7 (n-1) Jx(n) ΔΥ(η) = 1 cos r(n-1) -sinr(n-l) X Jy(n) △ z(t) 0 k -sin 7* (n-1) /cos ]3 (n -1 > cos 7 (n-l"cos5 <n-l)一 Jz(n) 其中/3 (η - 1 )和 7 (n-1)是在 t = n- 1時從方向角度記憶 體 (7 0 )謓取到的節距角/δ和滾動角7 , J X U ),J y ( η ),和 J ζ (η )是第一到第三進來的時間-序列數位信號在t = η 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) -------------裝--------訂---------線 (請先閱讀背面之注意事項再填寫本頁) 經濟部智慧財產局員工消費合作社印製 A8 B8 C8 D8 六、申請專利範圍 時的第一到第三數位信號。 9.如申請專利範圍第8項之方向角度檢測器,尚含有三 個高通濾波校正電路(311),這種高通滤波校正電路是 耦合於第一到第三類比-對-數位轉換器(307-309)與該 運動角度計算器(310)之間,而補償伴隨在第一到第三 髙通濾波器上的失真琨象而產生第一到第三已校正信 號,將該第一到第三已校正信號送到該運動角度計算 器(3 1 0 )上當作第一到第三進來的時間-序列數位信號 ,每一個高通滤波校正電路(311)都會執行由下列方程 式給定的計算: J(n)=F(n)+(At/RC)· EF(n) 其中J ( η )是對應到進來的第一到第三時間-序列數位 信號在t = n- l時的已校正信號,F(n)是在一個在t = n- l 時對應到第一到第三時間-序列數位信號的數位值, 而At/RC是一個常數值。 10.如申請專利範圍第9項之方向角度檢測器,其中該第 一到第三高通滹波校正電路(311)中每一個都含有一 積分器,此積分器則含有一第一叠加器(31101)及一 暫存器(3 11 0 2 ),係用於對相應的時間序列數位值積分 而將積分得到的數值保持於該暫存器(3 11 0 2 )内,為 了產生常數值而提供一常數值產生器(31103),倍增器 (31104)是耦合於該暫存器(31102)和該常數值產生器 (31103)上K便將已積分數值乘上此常數值而產生一已 倍增的數值,提供一第二叠加器(31105) Μ便將已倍增 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) ** 裝--------訂---------線 (請先閱讀背面之注意事項再<寫本頁) A8 B8 C8 D8 六、申請專利範圍 數值加到依時間-序列進來的數位值上而產生已校正 信號。 (請先閱讀背面之注意事項再^寫本頁> 11. 如申請專利範圍第10項之方向角度檢測器,其中該高 通濾波器校正電路(311)也含有一偏移誤差補償電路 (31106 - 31108)M補償由該積分器(31101-31102)及該 叠加器(31105)的計算造成的偏移誤差,該偏移誤差補 償電路含有一輸出定義器(31106广,係在將已校正信號 維持於常數時進行観測並定義出偏移誤差的位準,誤 差校正器(31107)是耦合於該輸出定義器(31106)上並 產生一個誤差校正信號Μ回應此誤差位準,將誤差校 正信號供應到該暫存器(3 11 0 2 >上,該暫存器(3 11 0 2 ) 則因而校正已積分數值,常數值校正電路(31108)也是 耦合於該誤差校正器(31107)上並校正該常數值產生器 (31103)的常數值Μ回應此誤差校正信號。 經濟部智慧財產局員工消費合作社印製 12. 如申請專利範圍第4項之方向角度檢測器,其中該第 一到第三高通滹波器可能是第一到第三數位式高通瀘 波裝置(第8圖)而分刖產生第一到第三時間-序列數 位濾波器輸出,該第一到第三數位式高通滅波裝置中 每一都含有一類比-對-数位轉換器(313)是耦合於某 一相對的該第一到第三陀螺儀(301-303)上W便在取樣 間隔St上對相應的第一到第三陀螺儀輸出進行取樣而 產生一種時間-序列數位信號,數位滤波器(315)是耦 合於該類比-對-數位轉換器(3 1 3 )上為時間-序列數位 信號進行滹波而產生相應的第一到第三時間-序列數 -40· 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) A8 B8 C8 D8 六、申請專利範圍 位滹波器輸出,運動角度計算器(310)會接收第一到 第三時間-序列數位滤波器輸出當作第一到第三進來 的時間-序列數位信號以產生代表著該蓮動角的三個 時間-序列移動角信號(ΛΧ,ΔΥ,ΔΖ),該方向角度計 算器(60)會接收該三個時間-序列移動角信號(ΛΧιΔ Υ,ΛΖ)Μ便依時間-序列產生該方向,角且該方向角度 記憶體(70)會儲存依時間-序列傳遞過來的該方向角c 13.如申請專利範圍第12項之方向角度檢測器,其中該第 一到第三時間-序列移動角信號代表著時間-序列χ -移 動角△ X(t),t = n, (η-1), (η-2),...,1,其中 n(n-l)=St 、時間-序列Y -移動角△¥(0、Μ及時間-序列Z -移動 角AZ(t),該蓮動角度計算器(310)會根據下列方程 式在t = n時計算出X -移動角ΔΧ(η)、Y -移動角ΛΥ(η)、 以及Ζ -移動ΛΖ(η): ΔΧ(η)' 0 tan )3 (n-l)sin T (n-1) tan β (n-1) cos T (n-1) ΔΥ(η) = 1 cos T(n-1) -sin r(n-1) X 0 -sin T (n^lj/cos β (n-1) cos 7 (n-1)/cos/3 (n-X)^ Π η· Jy 其中/S (η-1)和7 (η-1)是在t = l時從方向角度記憶 體(7 0 )讀取到的節距角/3和滾動角7 , J χ ( η ),J y ( η ), 和J ζ (η )是第一到第三進來的時間-序列數位信號在t=n, : 時的第一到第三數位信號。 14,如申請專利範圍第13項之方向角度檢測器,其中該數 位滹波器是一種具有延遲蜂衝值(P1,P2)的無限脈衝t 應(IIR)型式數位滹波器(315),且其中該數位式高通名 / -41 - 本紙張尺度適用中國國家標準(CNS)A4規格(210 χ 297公釐) ----------------- (請先閱讀背面之注意事項再#寫本頁) . 經濟部智慧財產局員工消費合作社印製 經濟部智慧財產局員工消費合作社印製 A8 Βδ C8 D8 六、申請專利範圍 波裝置(第8圖)也含有一正/負定義器(316)是耦合於 該數位濾波器(315)的一輸出端上以便當時間-序列數 位信號在正或負之間變換時産生一變換信號,且延遲 緩衝值重設電路(317)是耦合於該數位濾波器(315)和 該正/負定義器(#16)上並回應變換信號而産生該數位 濾波器(315)的該延遲緩衝值(Ρ1,Ρ2)β 15. 如申請專利範圍第14項之方向角度檢測器,其中該數 位式高通濾波裝置(第8圖)尚含有一偏移值産生器( 319)以産生一偏移值,以及一耩合於該偏移值産生器 (319)上的倍增器(32D),使該類比-對-數位轉換器313 與該數位濾波器3 1 5連接而以該偏移值使時間-序列數 位信號倍增,偏移值校正電路(318)是耦合於該偏移 值産生器(31 9)和該正/負定義器(3 16)上,且是用以 回應變換信號而産生偏移值。 16. 如申請專利範圍第2項之方向角度檢測器,其中該靜 態角度計算器(405)含有耦合於該第一和第二加速計( 403 ,404)上的第一和第二類比-對-數位轉換器(40501 ,40502),該第一和第二類比-對-數位轉換器(40501, 4 0 5 ϋ 2 )會在毎一個取樣間隔S t上對第一和第二加速計 檢测信號(Ax, Ay)進行取樣而産生第一和第二時間-序 列數位加速度信號,試驗性的節距角度計算器(40504) 是耦合於該第一類比-對-數位轉換器(40501)上,且會 從第一時間-序列數位加速度信號計算出一個試驗性的 節距角P,試驗性的滾動角度計算器(40503)是耦合於該 -4 2 - 本紙張尺度適用中國國家標準(CNS ) ( 210X297公釐) 訂 (請先閱讀背面之注意事項再填寫本頁)A8B8C8D8 經濟部智慧財產局員工消費合作社印製 六、申請專利範圍 第二類比-對-數位轉換器(40502)和該試驗性的節距角 度計算器(40504)上而從該第二時間-序列數位加速度 信號Μ及該試驗性的節距角P計算出一個試驗性的滾動 R,該試驗性的節距角Ρ和該試驗性的滾動角R都是該靜 態角的因子。 17. 如申請專利範圍第16項之方向角度檢测器,其中該第 一和第二時間-序列數位加速度信號表為Ax(t)和Ay(t) ,t = n,(n-1), (n-2),...,l,而 St=(n-1)時·,該試驗性的 節距角度計算器(40504)和該試驗性的滾動角度計算器 (40 503 )會分別根據下列方程式計算出試驗性的節距角 P和試驗性的滾動角R : P (n)=s i n Αχ(η) R ( η ) = s i η""*· tAy(n)/cosP(n)] 其中 P(n)、R(n)、Ax(n)、和 Ay(n)代表著在 t = n時 Ρ、 R、Ax (t)、和 Ay (t)的數值。 7t 18. 如申請專利範圍第17項之方向角度檢測器,其中該靜 態角度計算器(405 )也含有耦合於該第一和第二地磁 磁強計(401 ,402)上的第三和第四類比-對-數位轉換 器(40505,40506),會在每一取樣間隔St上對該第一和 第二磁場檢測信號Mx和My進行取樣而分別產生第一和 第二時間-序列數位磁場檢测信號,座標轉換器(40507) 是耦合於該第三和第四類比-對-數位轉換器(40505, 40506 )、該試驗性的滚動角度計算器(40503)、Μ及 該試驗性的節距角度計算器(40504)上而將該第一和 -43- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) - · ------------* -----— II 訂 *111!· ^^ (請先閱讀背面之注意事項再W寫本頁) 經濟部智慧財產局員工消費合作社印製 A8 B8 C8 D8 六、申請專利範圍 第二時間-序列數位磁場檢測信號轉換成第一和第二 時間-序列數位地磁分量信號,這兩涸信號代表著參 考的X-Y-Z座標上X-Y平面內對應的地磁分量Ηχ和Hy, 方位計算器(405 08 )是耦合於該座標轉換器(40507 )上 ,且會從地磁磁場分量Ηχ和Hy計算出一個方位角0而 產生一試驗性的擺動角Φ當作方位偏離角,方位記憶 體(40512)是耦合於該方位計算器(40508)上而用於儲 存方位角必。 1 9 .如申請專利範圍第1 8項之方向角度檢測器,其中該靜 態角度計算器(405 )也含有耦合於該第三和第四類比-對-數位轉換器(40505,40506)上的Z-方向磁場分量產 生器(40509-40515)會從該第一和第二磁場檢測信號 Mx和My產生一時間-序列數位Z-方向磁場分量信號Mz 、一先前量測得的地磁磁力Ht、一由量自X-Y平面之 檢測器座標之Xs和Ys軸所定義Xs-Ys平面上的初始歪 斜角Θ ^ 、一量自X-Y平面之Xs-Ys平面上的新近歪斜 角02 ,且該座標轉換器(40507)會根據下列方程式 從第一和第二磁場檢測信號Μ X和M y、時間-序列數位 Z \方向磁場分量信號Μ z、Μ及試驗性的節距和滾動角 Ρ和' R計算出地磁磁場分量Η X和H y : Hx(n)=cos[P(n)]x Mx(n)+sin[P(n)]x Mz(n) Hy(n)=sin[R(n)]x sin[P(n)]x Mx(n) +cos[R(n)]x cos[P(n)]x Mz(n) 其中 Hx(n),Hy(n),Mx(n),My(n),Mz(n),P(n),R(n)代 -44- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) --------I I---裝----- -- 訂·-----I I ·線 (請先閱讀背面之注意事項再^寫本頁) 六、申請專利範圍 A8 B8 C8 D8 經濟部智慧財產局員工消費合作社印製 表著在t=n時Hx,Hy,Mx,My,Mz,P,R的數值且該方位計 算器(40508)會根據下列方程式從Hx(n)和Hy(n)計算 出方位角必在t = n時的值角必(η): Φ (n)=-tan ^ [ Hy ( η )/Ηx ( η )] 且該方位計算器(4 0 5 0 8 )也會根據下列方程式從必(η ) Μ及一個初始的方位偏離角必(〇)計算出在t=n時的試 驗性擺動角Φ : Φ (η) = φ (η)~ Φ (0) 0 20.如申請專利範圍第19項之方向角度檢測器,其中該Ζ-方向磁場分量產生器(40509-40515)含有: 一地磁磁力產生器(40509-40510)Μ產生地磁磁力Ht 一新近Z -方向磁場分量絕對值計算器(40511)會根據 下列方程式從地磁磁力H t及該第一和第二時間-序列磁 場檢測信號Mx和My在t = n時的新近數值Mx(n)和My(n)計 算出Z-方向磁場分量絕緣值I Mzl : _ 〇 ο ·2 l/2 I Hz(n) I =[Ht^ - { M x ( η Γ+M y ( n ) }] 一新近歪斜角計算器(40513)是耦合於該方向角度記 憶體(70)及該方位記憶體(40512)上而計算出新近的歪 斜角Θ 2 ; 一符號定義器(40 5 1 4)是耦合於該新近歪斜角計算器 (40513)上而從該新近歪斜角02 Μ及該初始歪斜角% 為新近Ζ -方向磁場分量MzU)產生一個符號(+或- );Μ 及 一新近Ζ -方向磁場分量計算器(4 0 5 1 5 )是耦合於該新 -45- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 請 先 閱 讀 背 © 之 注 意 事 項 再 者 裝- 訂 線 A8 B8 C8六、申請專利範圍 — — — — — III — — — — » · I I I, .請先閲讀背面之注意事項再填寫本頁: 近z -方向磁場分量絕緣值計算器(40511)和該符號$ 義器(40 5 14)上而產生Z -方向磁埸分量Mz(n)。 21. 如申請專利範圍第20項之方向角度檢测器,其中纟亥1^ 磁磁力產生器(40509-40510)含有: —初始地磁磁力記憶體(40509)是分別透過兩 元件(S1,S2)而選擇性地耦合於該第三和第四類比-對’ 數位轉換器(40505,40506)上,並由該第三和第0胃tb -對-數位轉換器(40505,40506)透過兩個切換元件(S1’ S2)在初始時刻選擇性地切通而記憶下一個初始 向、Y-方向、和Z-方向的地磁磁場分量Mx(〇),My(Q)’ 和 Μ z (0 ) ; Μ 及 ·-線· —處理器(40510)是耦合於該初始地磁磁力記憶胃( 40509)上而根據下列方程式將初始的X -方向、Υ_方向 、和Ζ-方向的地磁磁場分量Μχ(0),Μιτ(0),和Μζ(〇)處 理成地磁磁力H t : 〇 2 2 1/2 | Ht I = [Mx (0) +My (0) +Mz (〇)] 地磁磁力的絕對值I Ht丨是當作該地磁磁力Ht記憶在 初始地磁磁力記憶體(40509)內。 經濟部智慧財產局員工消費合作社印製 22. 如申讅專利範圍第21項之方向角度檢測器,其中於初 始狀態下: 一方面將該方向角度檢測器定位成使該第一和第二 地磁磁強計(401,402)中特殊的一個是平行於該參考座 標的該Z軸,然後切通兩涸切換元件(S1,S2)中相應的 -4 6 * 本紙張尺度適用中國國家標準(CNS)A4规格(210 X 297公釐) 經濟部智慧財產局員工消費合作社印製 A8 B8 C8 D8 六、申請專利範圍 一個Μ便將由這個特殊的地磁磁強計(401,或402)檢 測得的地磁磁場分量記憶在該初始地磁磁力記憶體( 40509)内當作初始的Ζ-方向地磁磁場分量Mz(0);且 另一方面將4亥方向角度檢测器定位成使該第一和第 二地磁磁強計(40 1,402 )分別平行於該參考座標的該X 和Y軸,然後切通兩個切換元件(SI , S2)丨结果,將由第 一和第二地磁磁強計401和402檢測得的地磁磁場分量 記憶於初始地磁磁力記憶體(40509)內當作該初始的X-方向地磁磁場分量Μχ(0)和該初始的Y -方向地磁磁場 分量My (0)。 2 3 .如申請專利範圍第2 0項之方向角度檢測器,其中該新 近歪斜角計算器(40513)會根據下列方程式從在t = l 時自該方位記憶體(40512)讀出其角度數值為0 (n-1) 的方位角必以及自該方向角度記憶體(70)讀出其角度 數值為/3 ( η - 1 )和7 ( η - 1)的滾動和節距角/3和7而計 算出新近的歪斜角02 : .-1「 ,, 2 2 、ΐ/2 Ί = s1n L a a /( a a +cc ) J 0 24. 如申請專利範圍第23項之方向角度檢測器,其中該符 號定義器(40514) —方面會在新近歪斜角02大於初始 歪斜角Θ 〇時將符號定義成正( + ),而另一方面會在新 近歪斜角0 2等於或小於初始歪斜角0 〇但是大於- 9 0度角時將符號定義成負(-)。 25. 如申請專利範圍第2項之方向角度檢測器,尚含有一 個耦合於該靜態角度計算器(405)和該方向角度計算 -47 - 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) -------------裝---I----訂---------線 (請先閱讀背面之注意事項再_寫本頁) 經濟部智慧財產局員工消費合作社印製 A8 B8 C8 D8 六、申請專利範圍 器(60)上的靜態角度校正定義器(50),是用於靜態角 (P,R,0)的定義準確度K產生校正信號,且其中該方 向角度計算器(60)是用Μ回應校正信號而計算出一校 正數值並藉由校正數值校正一組已積分數值而產生一 組已修正數值,而將這組已修正數值當作方向角(α , /? , 7 )傳遞出去。 26. 如申請專利範圍第25項之方向角度檢測器,其中該方 向角度計算器60會根據下列方程式計算出第一到第三 已積分數值ΣΛΧ,ΣΛΥ,和ΣΛΖ: ΣΔΧ(η) = 7 (η-1)+ΔΧ(η), Σ Δ Υ (η) = (η-1 ) +Δ Υ (η), ΣΔΖ(η) = α (η-1)+ΔΖ(η), 其中Α Χ(η),Λ Υ(η),和△ Ζ(η)分別是在t = n時刻的X-移動角ΔΧ、Y-移動角ΔΥ、和Z-移動角ΛΖ,而7 (n-1) ,/3 (n-1),和α (n-1)分別是在t = n- l時刻的滾動角γ 、 節距角Θ和擺動角〇t ,而7 (n-l),/S (η-1),和〇( U-1) 都是從方向角記憶體(70)謓出來的。 27. 如申請專利範圍第26項之方向角度檢測器,其中該方 向角度計算器(6 0 )會在接收到校正信號時藉由下列方 程式計算出第一到第三角誤差Ex,Ey,和Εζ: Εχ= Σ Δ X(η)-R (η), Ey= Σ Δ Υ (η ) -Ρ (η), Εζ=ΣΔΖ(η)-Φ (η), 該方向角度計算器(60)會從第一到第三角誤差決定出 -4 8 ~ 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 1 — ·裝 { — — 訂---------線 (請先閱讀背面之注意事項再本頁) A8 B8 C8 D8 六、申請專利範圍 第一到第三校正數值C 1 , C 2 ,和C 3當作校正數值,並根據 下列方程式計算出第一到第三已修正數值當作滾動角 7 、節距角;8 、和擺動角α: 7 = Σ △ X (n) -Cl, β =Σ Δ Y(n)-C2, α = Σ Δ Z(n)~C3, 其中分別將數值Cl , C2 ,和C3選擇成小於第一到第三角 誤差Ex,Ey,和Εζ。 28. 如申請專利範圍第27項之方向角度檢測器,其中分別 由 klx Ex,k2x Ey,和 k3x Εζ 決定出數值 C1,C2,和 C3, 其中k 1,k 2 ,和k 3都是小於1的常數。 29. 如申請專利範圍第27項之方向角度檢測器,尚含有一 校正係數產生器(8 0 )是耦合於該靜態角度計算器(4 0 5 ) 和該方向角度計算器(60)上,且會產生一組第一到第 三係數ml, m2,和m3,該第一到第三係數和m3是 選自一組預定的不同數值Μ回應從該靜態角度計算器 (405)接收到的試驗性節距Ρ和試驗性滾動角R角數值, 且其中該方向角度計算器(6 0)是用Μ回應該組第一到 第三係數ml,m2,和m3而藉由分別乘上該第一到第三係 數m〗,m2,和!《3Μ修正該第一到第三校正數值C1,C2,和 C3 ° 30. 如申請專利範圍第26項之方向角度檢測器,其中該校 正定義器(50)上提供有一個靜態角度記憶體(501)是 用於儲存從該靜態角度計算器(4 0 5 )接收到的該試驗 -49- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 請 先 閱 讀 背 面 之 注 意 |(士. 頁 訂 線 經濟部智慧財產局員工消費合作社印製 A8 B8 C8 D8 六、申請專利範圍 (請先閲讀背面之注意事項再填寫本頁) 性節距P和該試驗性滾動角R,且其中該校正定義器(50) 會比較在時刻t = n接收到的試驗性節距P(n)和試驗性滾 動角R(n)與稍早在時刻t = n- l從該靜態角度記億體(501) 上讀出的試驗性節距P(n-l)和試驗性滾動角R(n-l),並 分別在滿足以下的方程式(1)和(2)時將該試驗性節距 角P(n)和該試驗性滾動角Μη)定義成準確的: I R(n)-R(n-1) | -Β= 0 (1) I Ρ(η)-P (η- 1 ) | -D = 0 (2) 其中B和D是選為正的數值。 31. 如申請專利範圍第30項之方向角度檢測器,其中該B 和D是一幾乎等於零(0 )的極小數值。 32. 如申請專利範圍第3D項之方向角度檢測器,其中該校 正定義器(50)是連接到該蓮動角度計算器(310)上且會 接收來自其上的X-移動角ΛΧ(η)和Y-移動角AYin),而 將B和D分別選為X-移動角△ X(n)和Y-移動角△ Y(n)。 經濟部智慧財產局員工消費合作社印製 33. ‘如申請專利範圍第30項之方向角度檢測器,其中該校 正定義器(50)會分別從該靜態角度計算器(405)和該蓮 動角度計算器(31Q)接收該試驗性擺動角Φ (t)和該Ζ-移動角ΛΖ(ΐ),該試驗性擺動角Φ(1:)是儲存於靜態角 度計算器(405)内,該校正定義器(50)會根據以下的方 程式(3)在時刻t = η處理試驗性擺動角Φ (η)和Ζ-移動角 △ Ζ(η)且在時刻t = n-處理自靜態角度記億體(501)讀取 到的擺動角Φ(η-1): I Φ (η) -Φ (η-1) | -Δ Ζ (η) = 0 (3) -50- 本紙張尺度適用中國國家標準(CNS ) A4規格(210 X 297公釐) 經濟部智慧財產局員工消費合作社印製 A8 B8 C8 D8 六、申請專利範圍 且當滿足方程式(3 )時該校正定義器(5 0 )會將試驗性 擺動角Φ (η)定義成是準確的。 \^4.如申請專利範圍第26項之方向角度檢測器,其中該校 正角度定義器(50)會於該靜態角度記憶體(501)内儲 存從該運動角計算器(310)接收到的X -移動角ΛΧ和Υ-移動角△ Υ , Μ及從該靜態角度計算器(405 )接收到的該 試驗性節距角Ρ(η)和該試驗性滚動角R(n),且其中該校 正定義器(5 0 )會計算出試驗性節距角P (t)變化的移動 平均值、試驗性滾動角R (t)變化的移動平均值、X -移 動角AX(t)的移動平均值、以及Y -移動角△¥('〇的移 動平均值,且會在滿足方程式(1)和(2 將試驗性節 I ""一 . 距角P(n)、試驗性滾動角(R)n、試驗性擺動角Φ (η) 定義成是準確的: [R (n) -R (n-1)]/C -[Δ Χ(η)+Δ Χ(η-1) + . . .+Δ X(n-C + 1)]/C^ 0 (1 ) [Ρ (η)-Ρ (n-1)]/C -[△ Υ(η)+Δ Υ(η-1) + ··.+Λ Y(n-C + 1)]/C 与 0 (2) 3 5 .如申請專利範圍第3 4項之方向角度檢測器,其中該校 正角度定義器(5 0 )會於該靜態角度記憶體(5 0 1)内儲存 從該運動角度計算器(310)接收到的Z -移動角ΔΖ,Μ及 從該靜態角度計算器(405 )接收到的該試驗性擺動角 Φ (η),且其中該校正定義器(50)會計算出試驗性擺動 角Φ (U變化的移動平均值Κ及Ζ-移動角的移 動平均值,且會在滿足方程式(3)時將試驗性擺動角 -5 1- 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) ------------- '— — —— — I— ^ — — — — — —— — a I J — /a\ (請先閲讀背面之注意事項再填寫本頁) rtr 1 i is· ^WHO X M0O^ S咎· 5 3 U12 K nt xw3S® i淫楚 SISs nl· I 0 活价 羼癜 9 fl s ——s 挪 s ^—— s I s s/ 3 1 (n — l)ew d >S , J y ( 3 ) ^ δ s s rt N 餐涅s 画被s i # s ® 雜 <3015,3005 乘函 _荪S-J i 5 ( J y , J N 侧涅黑画猶 H I i 讲 — 逋砘 I 3 s Y Z n 3 1o i 彌 C -7 ^ 0 $ ^ y _t i 5 i 3 挪 h ft ^ Y (^13 O ·)蜂¾ >乞/却 Z I I 8 ft ,t- = 3 ,. Ν3-1Ϊ=Κ£ 冰 s Λ *WB 窳勰(70) ϊ 3 3JN(n)_m - 3lnMi^31s — riss — 铖 h 楚 δδ 雞。 I- I l (321,322)4 Φ Mil s 挪一3® h 舰 )s 腌 (310-)藤液3 雄 咏棼 — -- 3 I hup > 3 3 1 _。 i (321,322)· Β ί ®ϊ細 3 Φ 5J ^Ε ϊ83¾¾ --SWH-si^sss® -500— J N Z o X y ^(冲),5対撕_#爾騰+械雖 ( rt=3l#+ 树 SY-®S®^Y 3 12 ΠΈ 3 Π S ~t i ^ ^ Μη $ (eo*嘛 1+¾¾ ¢60 油 o, κΐδ 铖 Ϊ3 ιί^=®8Λ 531¾ ^c ^1¾ ㈣㈣料) 經濟部智慧財產局員工消費合作杜印製 A8 B8 C8 D8 六、申請專利範圍 一和第二時間平均,該第一和第二震盪去除器(321, 3 22 )會分別比較第一和第二時間平均與第一和第二預 定臨限值,當該第一和第二時間平均小於該第一和第 二預定臨限值時,該第一和該_二震盪去除器(321, 342)會分別暫時地去除該第一和第二滹波器輸出的某 些部分並產生第一和第二已處理信號,而將第一和第 二已處理信號供應到蓮動角度計算器(3 1 0 ’)上當作第 一和第二進來信號。 55. 如申請專利範圍第48項之方向角度檢測器,其中該靜 態角度計算器(405)含有耦合於該加速計(403)上的第 一類比-對-數位轉換器(40501),該第一類比-對-數位 轉換器(4 0 5 0 1 )會在每一取樣間隔S t上對該加速計檢測 信號(A X )進行取樣而產生一時間-序列數位加速度信號 ,試驗性的節距角度計算器(40504)是耦合於該第一類 比-對-數位轉換器(40501)上,且會從第一時間-序列 數位加速度信號計算出一試驗性的節距角P。 56. 如申請專利範圍第55項之方向角度檢測器,其中該時 間-序列數位加速度信號是表為A X (t) , t = η,( η - 1 ) , ( η - 2 ) ,...,1 ,而S t = η (η - 1)時,該試驗性的節距角度計算器 (4 0 5 0 4 )和該試驗性的滾動角度計算器(4 0 5 0 3 )會分別 根據下列方程式計算出試驗性的節距角Ρ和試驗性的 滾動角R : P ( n ) = s i A X (η ), 其中P(n)和Ax(n)代表著在t = n時P和Ax(t)的數值。 -5 9 - 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) ^--------訂---------線 (請先閱讀背面之注意事項再填寫本頁) 六、申請專利範圍 Α8 Β8 C8 D8 該 中 其 器 測 檢 度 角合 向耦 方有 之含 項也 5 ) 5 , 第05 圍(4 範器 利算 專計 請度 申角 如態 地 二 第 和 1 第 該 於 靜磁 計05 UE 4 強 '^ 磁器 bb 類 三 轉 位 數 該 對 上 對 S -隔 間 榇 第取 0 I Π個 ί一二 第在 上,# 號 信 測 檢 場間 磁時 二二 第第 和和 和 進 換一 一 f第第 合 0 是 檢類 場三 磁第 位和 數二 列第 序該 -於 5 5 ο ο 5 4 ο ' 4 産算f =,f 換 分位 έ 而方Μ R ,數 樣虎 *m ^ 0 -了信-彳測比 测 檢 6)號當專個 50信Φ請一 場 Μ 0 磁的 位 性 數 Ji驗 列%? 序試 T値 間一 時生 二産 第而 P 夕 1 角 第位 該方 從個 會 一 且出 ,算 上計 角 離 偏 位 方 也計 該度 中角 其向 -方 器和 測') 檢05 度(4 角器 向算 方計 之度 項角 5 態 第靜 圍於 範合 作利耩 當 Φ 角申有 動如含 器號 義信 定正 正校 校生 度産 角以 態度 靜確 的準 上義 ')定 60的 ,--' ) 器 Φ 算Ρ, 角 態 靜 於 用 是 角 向 方 該 中 其 且 (請先閲讀背面之注意事項再填寫本頁) 正 校 值 數 正 ο校 (6由 器藉 算並 計值 度數 出 算 計 而 號 信 正 校 應 回 以 用 是 正 校 値 生 産 而 值 數 分 積 已 組 α /IV 角 向 方 作 當 值 數 正 修 已 組 這 將 而 值 ο 數去 正出 修遞 已傳 經濟部智慧財產局員工消費合作社印製 59.如申請專利範圍第58項之方向角度檢測器,其中該方 向角度計算器(601)會根據下列方程式計算出第一和第 二已積分數值Σ ΛΥ和Σ ΛΖ: Σ Δ Y(n) = /ff (η-1) +Δ Y(n), Σ Λ Ζ(η) = α (η-1)+Δ Ζ(η), 其中△ Υ(η)和△ Ζ(η)分別是在t = n時刻的卜移動角△ Υ -6 0 - 本紙張尺度適用中國國家標準(CNS ) Α4規格(210Χ297公釐) A8 B8 C8 D8 六、申請專利範圍 和Z -移動角Λ2,而^(n-l)和α (n-l)分別是在t = n- l 時刻的節距角冷和擺動角α ,而>5 (n-1)和《 (n-1)都 是從方向角度記億體(70)讀出來的。 60. 如申請專利範圍第59項之方向角度檢測器,其中該方 向角度計算器(60')會在接收到校正信號時藉由下列 方程式計算出第一到第三角誤差Ey和Ez: Ey= Σ Δ Υ(η)-P (η), Εζ=Σ △ Ζ(η)-Φ (η), 該方向角度計算器(60')會從第一和第二角誤差決定 出第一和第二校正數值C1和C2當作校正數值,並根據 下列方程式計算出第一和第二已修正數值當作節距角 疗和擺動角cr : β = Σ Δ Y(n)-Cl, a = Σ Δ Z(n)-C2, 其中分別將數值Cl和C 2選擇成小於第一和第二角誤差 E y 和 E z 〇 61. 如申請專利範圍第60項之方向角度檢測器,其中該校 正定義器(50’)是耦合於運動角度計算器(310')上,該 校正定義器(50')會計算出該試驗性節距角P(t)變化的 移動平均值、該試驗性滾動角R(t)變化的移動平均值 、該試驗性擺動角Φ(ί)變化的移動平均值、Y -移動角 AY(t)的移動平均值、以及Ζ-移動角AZ(t)的移動平 均值,並於滿足方程式(1)和(2)時將試驗性節距角P(n) 和試驗性擺動角Φ (η)定義成是準確的: -6 1 - 本紙張尺度逋用中國國家標準(CNS ) Α4規格(210 X 297公釐) (請先閲讀背面之注意事項再填寫本頁) -9· -Μ 經濟部智慧財產局員工消費合作社印製 A8 B8 C8 D8 六、申請專利範圍 [P (n)-P (n-l ) ]/C -[Δ Υ(η)+ΔΥ(η-1) + ...+Δ Y(n-C + 1)/CN Ο (1) (請先閱讀背面之注意事項再填寫本頁) Μ及 [Φ (η)-Φ (η-1)]/C -[△ Ζ(η)+Λ Ζ(η-1)+...+Δ Z(n-C + 1)/Ch Ο (2) 0 62. 如申請專利範園第59項之方向角度檢测器,其中該校 正定義器(5 0 ’)會於該試驗性節距角Ρ ( η )與該試驗性 擺動角Φ (η)中至少有一個是定義成準確的時候產生 校正信號,且該校正定義器(50 ’)會於該試驗性節距 角Ρ(η)與該試驗性擺動角Φ (η)中沒有任何一個是定 義成準確的時候產生非-校正信號,該方向角度計算器 (60')為了回應該非-校正信號將會產生該組已積分數 值(ΣΛΥ(η),ΣΔΖ(η))當作 2-D 方向角(/? ,α )。 經濟部智慧財產局員工消費合作社印製 63. 如申請專利範圍第62項之方向角度檢測器,其中該校 正定義器(50')也會在執行對該試驗性節距角Ρ和試驗 性擺動角φ準確度的定義程序中,於該試驗性節距角 Ρ和該試驗性擺動角Φ中某一特殊角是定義成準確的 時產生代表標示信號,且其中該方向角度計算器(60) 為了回應該非-校正信號將會產生該組已積分數值( ΣΛΥ(η),ΣΛΖ(η))當作 2-D 方向角(yS ,α )。 6 4 .如申請專利範圍第6 2項之方向角度檢測器,其中該校 正定義器(5 0 ’)會在碰到某些特殊的該試驗性節距角Ρ 和該試驗性擺動角Φ是定義成準確的情況時,能夠產 生代表著那些特殊的該試驗性節距角Ρ和該試驗性擺 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐) 8888 ABCD 六、申請專利範圍 動角Φ是定義成準確的一種標示信號當作校正信號, 且其中該方向角度計算器(60’)為了回應此標示信號 會藉由使用該試驗性節距角P和該試驗性擺動角Φ K 修正對應到那些特殊的該試驗性節距角P和該試驗性 擺動角Φ的一些特定的第一和第二已積分數值ΣΔΥ (η)和ΣΔΖ(η),而產生特定的校正數值,該方向角度 計算器(60’)會分別傳遞這些特定的Μ修正數值當作 特定的該節距角/S和該擺動角α亦即分別對應到那些 特定的該第一和第二已積分數值Σ ΔΥ(η)和Σ ΔΖ(η) ,且該方向角度計算器(60’)會傳遞除了那些特定的 該第一和第二已積分數值ΣΛΥ(η)和ΣΛ (Ζ)η之外剰 餘的其他已積分數值當作除了那些特定的該節距角/3 和該擺動角α之外剩餘的其他角度。 (請先閱讀背面之注意事項再填寫本頁) 經濟部智慧財產局員工消費合作社印製 -63 - 本紙張尺度適用中國國家標準(CNS)A4規格(210 X 297公釐)
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP37596698A JP3960574B2 (ja) | 1998-12-17 | 1998-12-17 | 姿勢角検出装置 |
JP37596598A JP4004165B2 (ja) | 1998-12-17 | 1998-12-17 | 姿勢角検出装置 |
JP37596798A JP3960575B2 (ja) | 1998-12-17 | 1998-12-17 | 姿勢角検出装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
TW392066B true TW392066B (en) | 2000-06-01 |
Family
ID=27341872
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW088112491A TW392066B (en) | 1998-12-17 | 1999-07-22 | Orientation angle detector |
Country Status (12)
Country | Link |
---|---|
US (1) | US6636826B1 (zh) |
EP (1) | EP1147373B1 (zh) |
KR (1) | KR20010105316A (zh) |
CN (1) | CN1145014C (zh) |
AU (1) | AU777641B2 (zh) |
CA (1) | CA2353629C (zh) |
DE (1) | DE69904759T2 (zh) |
HK (1) | HK1041044A1 (zh) |
MY (1) | MY118223A (zh) |
NO (1) | NO20013005L (zh) |
TW (1) | TW392066B (zh) |
WO (1) | WO2000036376A1 (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9261978B2 (en) | 2004-04-30 | 2016-02-16 | Hillcrest Laboratories, Inc. | 3D pointing devices and methods |
US9298282B2 (en) | 2004-04-30 | 2016-03-29 | Hillcrest Laboratories, Inc. | 3D pointing devices with orientation compensation and improved usability |
US9970789B2 (en) | 2015-10-23 | 2018-05-15 | Industrial Technology Research Institute | Automatic angle-measured apparatus and method using the same |
US10159897B2 (en) | 2004-11-23 | 2018-12-25 | Idhl Holdings, Inc. | Semantic gaming and application transformation |
TWI669489B (zh) * | 2014-08-08 | 2019-08-21 | 日商日本精工股份有限公司 | Angle detecting device, motor including the angle detecting device, torque sensor, electric power steering device, and automobile |
Families Citing this family (104)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040160414A1 (en) * | 1996-07-05 | 2004-08-19 | Armstrong Brad A. | Image controller |
US7749089B1 (en) | 1999-02-26 | 2010-07-06 | Creative Kingdoms, Llc | Multi-media interactive play system |
US6761637B2 (en) | 2000-02-22 | 2004-07-13 | Creative Kingdoms, Llc | Method of game play using RFID tracking device |
US7878905B2 (en) | 2000-02-22 | 2011-02-01 | Creative Kingdoms, Llc | Multi-layered interactive play experience |
US7445550B2 (en) | 2000-02-22 | 2008-11-04 | Creative Kingdoms, Llc | Magical wand and interactive play experience |
US7066781B2 (en) | 2000-10-20 | 2006-06-27 | Denise Chapman Weston | Children's toy with wireless tag/transponder |
AU2002230578A1 (en) * | 2000-10-30 | 2002-05-15 | Naval Postgraduate School | Method and apparatus for motion tracking of an articulated rigid body |
KR20020093024A (ko) | 2001-02-09 | 2002-12-12 | 미쓰비시덴키 가부시키가이샤 | 엘리베이터의 하중 검출장치 |
JP2003004450A (ja) * | 2001-06-25 | 2003-01-08 | Matsushita Electric Ind Co Ltd | 角速度および加速度検出用複合センサ |
US20070066396A1 (en) | 2002-04-05 | 2007-03-22 | Denise Chapman Weston | Retail methods for providing an interactive product to a consumer |
FR2838185B1 (fr) | 2002-04-05 | 2004-08-06 | Commissariat Energie Atomique | Dispositif de capture des mouvements de rotation d'un solide |
US6967566B2 (en) | 2002-04-05 | 2005-11-22 | Creative Kingdoms, Llc | Live-action interactive adventure game |
US7674184B2 (en) | 2002-08-01 | 2010-03-09 | Creative Kingdoms, Llc | Interactive water attraction and quest game |
KR100533106B1 (ko) * | 2002-08-06 | 2005-12-05 | 삼성전자주식회사 | 지자계 센서의 자세 오차 보상장치 및 방법 |
JP3837533B2 (ja) * | 2003-01-15 | 2006-10-25 | 独立行政法人産業技術総合研究所 | 姿勢角処理装置および姿勢角処理方法 |
US9446319B2 (en) | 2003-03-25 | 2016-09-20 | Mq Gaming, Llc | Interactive gaming toy |
CN100405014C (zh) * | 2004-03-05 | 2008-07-23 | 清华大学 | 一种载体姿态测量方法 |
US7464590B1 (en) | 2004-03-12 | 2008-12-16 | Thomson Licensing | Digitally programmable bandwidth for vibratory rate gyroscope |
DE102004064066B4 (de) * | 2004-06-09 | 2011-06-09 | Fendt, Günter | Verfahren zur Auswertung eines Drehratensignals eines Multifunktionsdrehratensensors |
FR2877113B1 (fr) | 2004-10-22 | 2007-05-11 | Commissariat Energie Atomique | Dispositif autonome, systeme et procede de navigation dans un espace a au moins trois dimensions. |
US7927216B2 (en) | 2005-09-15 | 2011-04-19 | Nintendo Co., Ltd. | Video game system with wireless modular handheld controller |
JP4805633B2 (ja) | 2005-08-22 | 2011-11-02 | 任天堂株式会社 | ゲーム用操作装置 |
US8313379B2 (en) | 2005-08-22 | 2012-11-20 | Nintendo Co., Ltd. | Video game system with wireless modular handheld controller |
US7942745B2 (en) | 2005-08-22 | 2011-05-17 | Nintendo Co., Ltd. | Game operating device |
JP4262726B2 (ja) | 2005-08-24 | 2009-05-13 | 任天堂株式会社 | ゲームコントローラおよびゲームシステム |
US8870655B2 (en) | 2005-08-24 | 2014-10-28 | Nintendo Co., Ltd. | Wireless game controllers |
US8308563B2 (en) | 2005-08-30 | 2012-11-13 | Nintendo Co., Ltd. | Game system and storage medium having game program stored thereon |
US8157651B2 (en) | 2005-09-12 | 2012-04-17 | Nintendo Co., Ltd. | Information processing program |
US7477973B2 (en) * | 2005-10-15 | 2009-01-13 | Trimble Navigation Ltd | Vehicle gyro based steering assembly angle and angular rate sensor |
US7602301B1 (en) * | 2006-01-09 | 2009-10-13 | Applied Technology Holdings, Inc. | Apparatus, systems, and methods for gathering and processing biometric and biomechanical data |
JP4530419B2 (ja) | 2006-03-09 | 2010-08-25 | 任天堂株式会社 | 座標算出装置および座標算出プログラム |
JP4151982B2 (ja) | 2006-03-10 | 2008-09-17 | 任天堂株式会社 | 動き判別装置および動き判別プログラム |
KR100709277B1 (ko) * | 2006-03-22 | 2007-04-19 | 한국원자력연구소 | 단축가속도계를 이용해 횡방향 봉 진동 측정을 위한 봉내삽입형 이축가속도 신호계측 치구 |
JP4684147B2 (ja) | 2006-03-28 | 2011-05-18 | 任天堂株式会社 | 傾き算出装置、傾き算出プログラム、ゲーム装置およびゲームプログラム |
JP5043358B2 (ja) * | 2006-04-04 | 2012-10-10 | ラピスセミコンダクタ株式会社 | 傾斜角演算方法及び傾斜角演算装置 |
US7996131B2 (en) * | 2006-06-02 | 2011-08-09 | Mitsubishi Electric Corporation | Tilt angle detecting apparatus for vehicle, and rollover judging apparatus using this tilt angle detecting apparatus for vehicle |
JP5127242B2 (ja) | 2007-01-19 | 2013-01-23 | 任天堂株式会社 | 加速度データ処理プログラムおよびゲームプログラム |
US7950281B2 (en) * | 2007-02-28 | 2011-05-31 | Infineon Technologies Ag | Sensor and method for sensing linear acceleration and angular velocity |
DE102007011816B4 (de) * | 2007-03-12 | 2013-10-02 | Infineon Technologies Ag | Sensor und Verfahren zum Erfassen einer Linearbeschleunigung und einer Winkelgeschwindigkeit |
EP2028584A1 (en) * | 2007-08-23 | 2009-02-25 | STMicroelectronics S.r.l. | Pointing and control device and method for a computer system |
EP2140916B1 (en) | 2008-06-30 | 2018-10-31 | Nintendo Co., Ltd. | Coordinate calculation apparatus and storage medium having coordinate calculation program stored therein |
EP2140915B1 (en) | 2008-06-30 | 2019-03-06 | Nintendo Co., Ltd. | Orientation calculation apparatus, storage medium having orientation calculation program stored therein, game apparatus, and storage medium having game program stored therein |
WO2010001968A1 (ja) * | 2008-07-02 | 2010-01-07 | 独立行政法人産業技術総合研究所 | 移動体の測位装置 |
US8384565B2 (en) * | 2008-07-11 | 2013-02-26 | Nintendo Co., Ltd. | Expanding operating device and operating system |
JP2012503194A (ja) * | 2008-09-23 | 2012-02-02 | コーニンクレッカ フィリップス エレクトロニクス エヌ ヴィ | 加速度計からの測定値を処理する方法 |
JP2010117260A (ja) * | 2008-11-13 | 2010-05-27 | Epson Toyocom Corp | 姿勢検出装置の補正パラメーター作成方法、姿勢検出装置の補正パラメーター作成用装置及び姿勢検出装置 |
US8099876B1 (en) * | 2008-11-21 | 2012-01-24 | The Boeing Company | Azimuth determination system and method therefor |
DE102009001247A1 (de) * | 2009-02-27 | 2010-09-09 | Sensordynamics Ag | Mikro-elektro-mechanischer Sensor |
EP2228110B1 (en) | 2009-03-09 | 2017-08-30 | Nintendo Co., Ltd. | Coordinate calculation apparatus and storage medium having coordinate calculation program stored therein |
JP5182708B2 (ja) * | 2009-06-17 | 2013-04-17 | ダンロップスポーツ株式会社 | ゴルフスイングの分析方法 |
JP2011019035A (ja) * | 2009-07-08 | 2011-01-27 | Ricoh Co Ltd | 情報装置、該装置を搭載した撮像装置および角度補正方法 |
US9760186B2 (en) * | 2010-01-06 | 2017-09-12 | Cm Hk Limited | Electronic device for use in motion detection and method for obtaining resultant deviation thereof |
JP5798713B2 (ja) * | 2009-08-28 | 2015-10-21 | ラピスセミコンダクタ株式会社 | 電子機器、運動検出方法及びプログラム |
KR20110035609A (ko) * | 2009-09-30 | 2011-04-06 | 삼성전자주식회사 | 움직임 감지 장치 및 방법 |
JP5547985B2 (ja) * | 2010-02-22 | 2014-07-16 | ラピスセミコンダクタ株式会社 | 運動検出装置、電子機器、運動検出方法及びプログラム |
IT1399418B1 (it) * | 2010-04-12 | 2013-04-16 | Selex Galileo Spa | Apparecchio elettronico per determinare l'assetto di un'arma e relativo metodo di funzionamento. |
US9024772B2 (en) | 2010-09-28 | 2015-05-05 | Xianghui Wang | Multi sensor position and orientation measurement system |
US8344303B2 (en) * | 2010-11-01 | 2013-01-01 | Honeywell International Inc. | Projectile 3D attitude from 3-axis magnetometer and single-axis accelerometer |
US8463569B2 (en) * | 2011-03-21 | 2013-06-11 | Caterpillar Trimble Control Technologies Llc | Method of operating a magnetic compass on a machine |
CN102322858B (zh) * | 2011-08-22 | 2013-01-09 | 南京航空航天大学 | 用于地磁/捷联惯导组合导航系统的地磁匹配导航方法 |
KR101303939B1 (ko) * | 2011-10-17 | 2013-09-05 | 한국과학기술연구원 | 디스플레이 장치 및 컨텐츠 디스플레이 방법 |
RU2486098C1 (ru) * | 2012-01-25 | 2013-06-27 | Открытое акционерное общество "Конструкторское Бюро Промышленной Автоматики" | Устройство для определения углов крена и дифферента подвижных объектов |
GB2501761A (en) * | 2012-05-04 | 2013-11-06 | Sony Comp Entertainment Europe | Head mountable display |
GB2501767A (en) | 2012-05-04 | 2013-11-06 | Sony Comp Entertainment Europe | Noise cancelling headset |
GB2501768A (en) | 2012-05-04 | 2013-11-06 | Sony Comp Entertainment Europe | Head mounted display |
US9200973B2 (en) | 2012-06-28 | 2015-12-01 | Intel Corporation | Semiconductor package with air pressure sensor |
CN103017765B (zh) * | 2012-12-06 | 2015-05-27 | 北京遥测技术研究所 | 应用于微机械组合导航系统的偏航角修正方法和修正装置 |
US9429427B2 (en) | 2012-12-19 | 2016-08-30 | Intel Corporation | Inductive inertial sensor architecture and fabrication in packaging build-up layers |
US8915116B2 (en) * | 2013-01-23 | 2014-12-23 | Freescale Semiconductor, Inc. | Systems and method for gyroscope calibration |
CN103114846B (zh) * | 2013-01-25 | 2016-05-25 | 北京航空航天大学 | 一种基于光纤陀螺测斜仪的测斜数据的事后处理系统 |
CN104246864B (zh) * | 2013-02-22 | 2016-06-29 | 索尼公司 | 头戴式显示器和图像显示装置 |
US10132829B2 (en) * | 2013-03-13 | 2018-11-20 | Invensense, Inc. | Heading confidence interval estimation |
US20140372074A1 (en) * | 2013-06-14 | 2014-12-18 | Memsic, Inc. | Tip-over sensor |
JP2015027015A (ja) * | 2013-07-29 | 2015-02-05 | ソニー株式会社 | 情報提示装置及び情報処理システム |
EP2883272B1 (en) * | 2013-08-27 | 2016-06-15 | CommScope Technologies LLC | Alignment determination for antennas and such |
WO2015040133A1 (de) | 2013-09-18 | 2015-03-26 | Horsch Leeb Application Systems Gmbh | Vorrichtung zum ausbringen von flüssigen und/oder festen wirkstoffen und verfahren zur steuerung einer solchen vorrichtung |
WO2015067804A1 (de) | 2013-11-10 | 2015-05-14 | Horsch Leeb Application Systems Gmbh | Vorrichtung zum ausbringen von flüssigen und/oder festen wirkstoffen und verfahren zur steuerung einer solchen vorrichtung |
US10338678B2 (en) | 2014-01-07 | 2019-07-02 | Nod, Inc. | Methods and apparatus for recognition of start and/or stop portions of a gesture using an auxiliary sensor |
US10725550B2 (en) * | 2014-01-07 | 2020-07-28 | Nod, Inc. | Methods and apparatus for recognition of a plurality of gestures using roll pitch yaw data |
US9606364B2 (en) | 2014-09-12 | 2017-03-28 | Microsoft Technology Licensing, Llc | Stabilizing motion of an interaction ray |
US9683845B2 (en) | 2014-09-26 | 2017-06-20 | Intel Corporation | Virtual gyroscope using dual magnetometers for electronic devices |
JP2016110319A (ja) * | 2014-12-04 | 2016-06-20 | ソニー株式会社 | 表示制御装置、表示制御方法およびプログラム |
CN105783921B (zh) * | 2014-12-17 | 2019-02-19 | 高德软件有限公司 | 一种校正汽车姿态数据的方法及装置 |
JP6362556B2 (ja) * | 2015-02-26 | 2018-07-25 | キヤノン株式会社 | 制御装置、撮像装置、制御方法、プログラム、および、記憶媒体 |
DE102015102975A1 (de) | 2015-03-02 | 2016-09-08 | Horsch Leeb Application Systems Gmbh | Vorrichtung zum Ausbringen von flüssigen und/oder festen Wirkstoffen und Verfahren zur Steuerung einer solchen Vorrichtung |
US20160259404A1 (en) * | 2015-03-05 | 2016-09-08 | Magic Leap, Inc. | Systems and methods for augmented reality |
WO2016146130A1 (en) * | 2015-03-13 | 2016-09-22 | Sang Yinan | Attitude detecting device |
CN105894607B (zh) * | 2015-04-30 | 2018-09-07 | 睿驰智能汽车(广州)有限公司 | 行车记录装置及利用行车记录装置的调整控制方法 |
JP6429199B2 (ja) * | 2015-05-29 | 2018-11-28 | 日立オートモティブシステムズ株式会社 | 慣性センサ |
WO2017095951A1 (en) | 2015-11-30 | 2017-06-08 | Nike Innovate C.V. | Apparel with ultrasonic position sensing and haptic feedback for activities |
US10365104B2 (en) * | 2016-05-11 | 2019-07-30 | Murata Manufacturing Co., Ltd. | Digital controller for a MEMS gyroscope |
CN106017406A (zh) * | 2016-05-17 | 2016-10-12 | 北京小米移动软件有限公司 | 测量目标物距离的方法和装置 |
JP2018019024A (ja) * | 2016-07-29 | 2018-02-01 | キヤノン株式会社 | 振動を発生させる振動部品が実装されるプリント基板 |
CN106768549A (zh) * | 2016-12-12 | 2017-05-31 | 北京信息科技大学 | 一种高动态载体环境力测量装置 |
DE102017208365A1 (de) * | 2017-05-18 | 2018-11-22 | Robert Bosch Gmbh | Verfahren zur Orientierungsschätzung eines tragbaren Gerätes |
EP3688513A1 (de) * | 2017-09-25 | 2020-08-05 | Continental Automotive GmbH | Head-up-display |
CN107941463B (zh) * | 2017-10-26 | 2020-11-10 | 深圳多哚新技术有限责任公司 | 头戴设备水平缺陷检测方法及系统 |
CN108196678A (zh) * | 2018-01-19 | 2018-06-22 | 昆山国显光电有限公司 | 手势操作方法及带手势操作功能的电子设备 |
CN108827289B (zh) * | 2018-04-28 | 2021-09-07 | 诺亚机器人科技(上海)有限公司 | 一种机器人的方位识别方法及系统 |
CN109129523B (zh) * | 2018-08-30 | 2021-07-06 | 燕山大学 | 基于人机交互的移动机器人实时远程控制系统 |
JP7394352B2 (ja) * | 2019-03-26 | 2023-12-08 | パナソニックIpマネジメント株式会社 | 信号処理装置、慣性力センサ、信号処理方法、及びプログラム |
CN112902952B (zh) * | 2021-01-21 | 2023-11-10 | 中国煤炭科工集团太原研究院有限公司 | 基于毫米波雷达和惯性导航的掘进机位姿检测方法 |
CN113055598B (zh) * | 2021-03-25 | 2022-08-05 | 浙江商汤科技开发有限公司 | 朝向数据补偿方法、装置、电子设备、可读存储介质 |
CN114485760B (zh) * | 2022-01-26 | 2023-10-31 | 震坤行工业超市(上海)有限公司 | 传感器校准方法、电子设备、介质及系统 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4254465A (en) * | 1978-08-03 | 1981-03-03 | Dynamic Sciences International, Inc. | Strap-down attitude and heading reference system |
FR2511146B1 (fr) * | 1981-08-07 | 1986-07-25 | British Aerospace | Instrument de navigation |
US4559713A (en) * | 1982-02-24 | 1985-12-24 | Applied Technologies Associates | Azimuth determination for vector sensor tools |
FR2614694B1 (fr) * | 1987-04-28 | 1989-06-30 | Equip Navigation Aerienne | Centrale d'attitude integree pour aerodyne |
US5526022A (en) * | 1993-01-06 | 1996-06-11 | Virtual I/O, Inc. | Sourceless orientation sensor |
US5373857A (en) | 1993-06-18 | 1994-12-20 | Forte Technologies, Inc. | Head tracking apparatus |
-
1999
- 1999-07-22 DE DE69904759T patent/DE69904759T2/de not_active Expired - Fee Related
- 1999-07-22 TW TW088112491A patent/TW392066B/zh not_active IP Right Cessation
- 1999-07-22 CN CNB99816237XA patent/CN1145014C/zh not_active Expired - Fee Related
- 1999-07-22 AU AU47995/99A patent/AU777641B2/en not_active Ceased
- 1999-07-22 WO PCT/JP1999/003936 patent/WO2000036376A1/en not_active Application Discontinuation
- 1999-07-22 CA CA002353629A patent/CA2353629C/en not_active Expired - Fee Related
- 1999-07-22 US US09/858,000 patent/US6636826B1/en not_active Expired - Fee Related
- 1999-07-22 EP EP99931494A patent/EP1147373B1/en not_active Expired - Lifetime
- 1999-07-22 KR KR1020017007662A patent/KR20010105316A/ko not_active Application Discontinuation
- 1999-07-23 MY MYPI99003113A patent/MY118223A/en unknown
-
2001
- 2001-06-15 NO NO20013005A patent/NO20013005L/no unknown
-
2002
- 2002-04-16 HK HK02102865A patent/HK1041044A1/xx not_active IP Right Cessation
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9261978B2 (en) | 2004-04-30 | 2016-02-16 | Hillcrest Laboratories, Inc. | 3D pointing devices and methods |
US9298282B2 (en) | 2004-04-30 | 2016-03-29 | Hillcrest Laboratories, Inc. | 3D pointing devices with orientation compensation and improved usability |
US9575570B2 (en) | 2004-04-30 | 2017-02-21 | Hillcrest Laboratories, Inc. | 3D pointing devices and methods |
US9946356B2 (en) | 2004-04-30 | 2018-04-17 | Interdigital Patent Holdings, Inc. | 3D pointing devices with orientation compensation and improved usability |
US10514776B2 (en) | 2004-04-30 | 2019-12-24 | Idhl Holdings, Inc. | 3D pointing devices and methods |
US10782792B2 (en) | 2004-04-30 | 2020-09-22 | Idhl Holdings, Inc. | 3D pointing devices with orientation compensation and improved usability |
US11157091B2 (en) | 2004-04-30 | 2021-10-26 | Idhl Holdings, Inc. | 3D pointing devices and methods |
US10159897B2 (en) | 2004-11-23 | 2018-12-25 | Idhl Holdings, Inc. | Semantic gaming and application transformation |
US11154776B2 (en) | 2004-11-23 | 2021-10-26 | Idhl Holdings, Inc. | Semantic gaming and application transformation |
TWI669489B (zh) * | 2014-08-08 | 2019-08-21 | 日商日本精工股份有限公司 | Angle detecting device, motor including the angle detecting device, torque sensor, electric power steering device, and automobile |
US9970789B2 (en) | 2015-10-23 | 2018-05-15 | Industrial Technology Research Institute | Automatic angle-measured apparatus and method using the same |
Also Published As
Publication number | Publication date |
---|---|
CN1334915A (zh) | 2002-02-06 |
NO20013005D0 (no) | 2001-06-15 |
HK1041044A1 (en) | 2002-06-28 |
DE69904759D1 (de) | 2003-02-06 |
CA2353629A1 (en) | 2000-06-22 |
EP1147373A1 (en) | 2001-10-24 |
WO2000036376A1 (en) | 2000-06-22 |
MY118223A (en) | 2004-09-30 |
DE69904759T2 (de) | 2003-09-25 |
NO20013005L (no) | 2001-06-15 |
CN1145014C (zh) | 2004-04-07 |
EP1147373B1 (en) | 2003-01-02 |
KR20010105316A (ko) | 2001-11-28 |
US6636826B1 (en) | 2003-10-21 |
AU777641B2 (en) | 2004-10-28 |
AU4799599A (en) | 2000-07-03 |
CA2353629C (en) | 2005-12-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TW392066B (en) | Orientation angle detector | |
Unsal et al. | Estimation of deterministic and stochastic IMU error parameters | |
US6836971B1 (en) | System for using a 2-axis magnetic sensor for a 3-axis compass solution | |
TWI512548B (zh) | 移動軌跡產生方法 | |
GB2146776A (en) | Accelerometer systems | |
JPH11505620A (ja) | 地磁場の方向の算定のための方法 | |
KR20040013439A (ko) | 지자계 센서의 자세 오차 보상장치 및 방법 | |
TW200403439A (en) | Acceleration measuring apparatus with calibration function | |
CN102575933A (zh) | 地图图像综合数据库生成系统以及地图图像综合数据库生成程序 | |
Shibata | Error analysis strapdown inertial navigation using quaternions | |
JP2023050517A (ja) | 慣性センサーデバイス及びセンサーモジュール | |
CN107270902B (zh) | 一种带有交叉轴耦合误差补偿的mems惯性测量单元 | |
Fan et al. | A unified scheme for rotation modulation and self-calibration of dual-axis rotating SINS | |
JP3960574B2 (ja) | 姿勢角検出装置 | |
JP5457890B2 (ja) | 方位検知装置 | |
JP3505057B2 (ja) | ペン型入力装置 | |
Milovzorov et al. | Concept of information signals reforming for the tilt measurement systems with a triaxial accelerometer | |
CN112971983B (zh) | 姿态数据的测量方法、装置、电子设备及存储介质 | |
RU129625U1 (ru) | Инерциальный измерительный модуль | |
CN211696377U (zh) | 测量用平台装置 | |
JPH11211479A (ja) | 姿勢角検出装置 | |
RU2343418C1 (ru) | Устройство для определения углового положения подвижного объекта относительно вектора силы тяжести и способ его использования | |
RU131489U1 (ru) | Датчик первичной инерциальной информации | |
RU2439498C1 (ru) | Комплексная инерциально-спутниковая навигационная система | |
RU2282199C1 (ru) | Бесплатформенная система ориентации |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
GD4A | Issue of patent certificate for granted invention patent | ||
MM4A | Annulment or lapse of patent due to non-payment of fees |