TW392066B - Orientation angle detector - Google Patents

Orientation angle detector Download PDF

Info

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
Application number
TW088112491A
Other languages
English (en)
Inventor
Hiroshi Abe
Kazutake Muto
Original Assignee
Tokin Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Priority claimed from JP37596698A external-priority patent/JP3960574B2/ja
Priority claimed from JP37596598A external-priority patent/JP4004165B2/ja
Priority claimed from JP37596798A external-priority patent/JP3960575B2/ja
Application filed by Tokin Corp filed Critical Tokin Corp
Application granted granted Critical
Publication of TW392066B publication Critical patent/TW392066B/zh

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/18Stabilised platforms, e.g. by gyroscope
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F3/00Input 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/01Input arrangements or combined input and output arrangements for interaction between user and computer
    • G06F3/011Arrangements for interaction with the human body, e.g. for user immersion in virtual reality
    • G06F3/012Head tracking input arrangements
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • G01C19/56Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/165Navigation; 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/1654Navigation; 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
    • GPHYSICS
    • G02OPTICS
    • G02BOPTICAL ELEMENTS, SYSTEMS OR APPARATUS
    • G02B27/00Optical systems or apparatus not provided for by any of the groups G02B1/00 - G02B26/00, G02B30/00
    • G02B27/01Head-up displays
    • G02B27/017Head mounted
    • GPHYSICS
    • G02OPTICS
    • G02BOPTICAL ELEMENTS, SYSTEMS OR APPARATUS
    • G02B27/00Optical systems or apparatus not provided for by any of the groups G02B1/00 - G02B26/00, G02B30/00
    • G02B27/01Head-up displays
    • G02B27/0179Display position adjusting means not related to the information to be displayed
    • G02B2027/0187Display 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
    • GPHYSICS
    • G02OPTICS
    • G02BOPTICAL ELEMENTS, SYSTEMS OR APPARATUS
    • G02B27/00Optical systems or apparatus not provided for by any of the groups G02B1/00 - G02B26/00, G02B30/00
    • G02B27/01Head-up displays
    • G02B2027/0192Supplementary details
    • G02B2027/0198System 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)

  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公釐)
TW088112491A 1998-12-17 1999-07-22 Orientation angle detector TW392066B (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Cited By (11)

* Cited by examiner, † Cited by third party
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