TW200905166A - Auto-calibration of orientation sensing system - Google Patents

Description

200905166 九、發明說明： 【發明所屬之技術領域】 發明領域 本發明係關於一種具有包括用以感測加速度之第一感 5測器以及用以感測磁場之第二感測器的一方位感測系統之 電子裝置。該方位感測系統包括—校準系統。該裝置是， 例如，行動電話、掌上型電腦PC或個人數位助理、或用於 陸地車輛、小船或飛機等等之獨立的電子導航裝置之一電 子移動裝置。本發明同時也是關於一種校準此系統之方法 10以及關於用以在一微處理機上進行這方法的軟體。 I：先前技術；3 發明背景 羅盤磁力計被校準以便補償偏移、標度因子偏移、對 齊容限以及磁材料之影響。該補償降低裝置計算方位之誤 15差。上it之影響，並且特別是磁材料之影帛，可隨時間改 變。-般在使用於運載工具中的電池更換之後，或在暴露 於強的磁場之後則需要被重新校準。自動校準技術同時 也可被使用以取代-次的工廠校準，因此節省製造成本。 國際專利申請第W02M6693號案揭示一種三軸的代數 20模式以數值地補償在用於任何羅盤方位的電子羅盤中所量 測的磁場值之磁誤差。這模式是依據物理原理以及使用便 利於補償所需參數之計算的線性代數方法。在電子羅盤之 校準步驟期間，磁場及重力場以多種方位及方位角之各組 合上的三個軸被量測。這組量測磁場和重力場被使用以使 200905166 用-方程式系統計算-矩陣補償係數以及—向量補 數。這些補償係數被儲存並且接著在電子羅盤正常操作= 間被使用，以針對地球磁場更正所有依序量測的磁力外 料’以得収正之數值，由其巾正確之株角可被計算出。 5 【明内容】 發明概要 國際專利申請第WO02/46693號案揭* 一種可避 要分別的標頭校準之供用於„3D磁力計的自動校準技術。 該羅盤具有-3D加速計並且必須在校準期間，被保持在差 H)不多平均地分佈在空間中之至少十二個不同的方位。習知 的技術是受限制於-3D磁力計以及一3D加速計之組合。其 不能被使用於其中一或兩個感測器皆僅是2 D的情況中。 本發明之-目的是提供-種自動校準技術，其可被使 用於-2D或3D磁力計以及一扣或犯加速計之任何紅人 15 中。 〇 為這目的，本發明者提出—種電子裝置，其具有用以 在該裝置操作使用時決定該裝置一方位之方位感測系統。 該方位感測系統包括：用以供應代表包括地球磁場向量之 感測磁場向量的第一向量之第—感測器；及用以供應代表 重力場向里之感測加速度向量的第二向量之第二感測 器。該方位感测系統同時也包括相合至該等第一及第二感 測器並且可操作以校準供操作使用之該感測系統的校準裝 置°亥才又準襄置使用該等第二向量以對該裝置多數個方位 之對應的每-方位限定將被決定的地球磁場向量之對應的 200905166 一向量之可能方向範圍。該校準裝置是可操作以數值地解 出涉及該等代表第一向量之第一數量及該等代表第二向量 之第一數量的一組方程式。該組方程式包含，對於各該等 第一數量，一個對應的方程式（1〇2)，參考第1圖，其包括等 5於一參數矩陣與對應地球磁場向量之矩陣相乘的一項。 該磁力計之輸出信號是取決於地球磁場向量的一向 里。έ亥取決於地球磁場向量之依賴性藉由一矩陣與地球磁 場向量之乘積的項被表示。該地球磁場向量是一3D向量。 在國際專利申請第WO02/46693號案中之技術依賴於使用 10這矩陣之反矩陣，因此一般將需要一個方陣3X3矩陣。因 此，在國際專利申請第WO02/46693號案中之技術被限制使 用3D磁力計。更進一步地，國際專利申請第w〇〇2/46693 號案使用一種3D加速計。習知的方法因此不能被應用於使 用一種2D磁力計及/或一種2D加速計之組態。在本發明中， 15使用表示磁力計的輸出向量為一矩陣轉換3D地球磁場向量 之方程式之技術，將不被限制在一種3〇磁力計以及3D加速 s十組態。本發明能夠使用一 2d或3D磁力計與一 2D或3D加 速計的不同組合。 如果一3D磁力計和一3D加速計將被使用，則一組方程 20式將以數值解出，其包括對於各方位之一向量方程式，而 具有一項疋4於一參數矩陣與地球磁場向量之一矩陣相 乘。該組方程式進一步地包括對於各方位之一純量方裎 式，其表示在量測被實行位置上，與方位感測系統的方位 無關之情況中，地球磁場向量大小是常數。該組方程式同 200905166 時也包括對於各方位之一純量方程式，其表示地球磁場向 量和重力向量之内積是與量測位置之方位無關。為了解出 該組方程式，至少需有7個不同的方位以找出補償必須的校 準參數數值。 5 對於一 2D磁力計以及一 3D加速計之組合，一組相似之 方程式被使用作為在上一段中所討論的3D/3D組態。接著， 至少需有9個不同的方位。 對於包—個2D或3 D磁力計以及一個2D加速計之組 合，該組方程式被延伸而具有包括一矩陣轉換之向量方程 10 式以映射該3D重力向量在其一個2D表示上，以及具有指出 該重力向量大小是與該量測位置之方位無關的純數方程 式。在該3D磁力計以及2D加速計之組態中，至少需有7個 不同的方位以用以得到校準參數。在該2D/2D組態中，至少 需有9個不同的方位。 15 在本發明一實施例中，各該等第一數量是利用第一感 測器被供應之多數個第一向量的一平均量。這平均量消除 變動之影響，因此改善精確度。 在進一步的一實施例中，各該等第二數量是利用第二 感測器被供應之多數個第二向量的一平均量。這平均量同 20 樣地消除變動之影響並且因此改善精確度。 在進一步的一實施例中，該校準裝置是可操作以排除 該等第一向量之一特定向量以及該等第二向量之及時對應 的一特定向量被考慮用以產生該等第一數量的一特別數量 作為該等第一向量之特別向量的第一平均數量，以及用以 200905166 產生該等第二數量的一對應特別數量作為該等第二向量之 特別向量的第二平均數量，並且如果下列條件出現，則終 止該特別第一數量之產生以及該對應的特別第二數量之產 生：該特定第一向量偏離該等特別第一向量之第一平均數 5 量的一執行形態為超出一第一個臨界之向量距離時；或該 特定第二向量偏離該等特別第二向量之第二平均數量的一 執行形態為超出一第二個臨界之向量距離時。 因此，到目前為止，當第一感測器或該第二感測器供 應偏離執行平均量之一取樣而超出某一距離之時，該等第 10 一及/或第二向量之平均量的產生被終止。如果該平均量自 較少於某一最小數目之取樣被產生而時，則該平均量將被 忽略。這方法降低所彙集的整體資料之關於動態方位改變 以及機械振動的影響。 在進一步的另一實施例中，如果該特別的第二數量具 15 有大小偏離一另外的預定數值多於一另外的臨界時，則該 等第一數量之一特定數量以及該等第二數量之及時對應的 一特定數量將從欲被解出之該組方程式中予以排除。 第二數量之大小被假設為重力標稱大小之表示。如果 第二數量之大小偏離該標稱大小時，該裝置除了重力之外 20 還遭受一加速度。該等第二數量代表該裝置在一特定時間 區間所感受的平均加速度之量測。如果該裝置相對於地球 將被保持不動，或在一固定方向以一均勻的速率被移動， 則被感測之加速度只是重力之良好表示。如果該裝置被加 速，被感測之混合加速度則不是重力之表示。因而，解出 200905166 該組方程式以及因此得到校準參數之計算將不再是有效 的。該等量測之條件排除則保存所收集資料的整體性。 在進一步的另一實施例中，如果在一方面之分別的第 一數量或分別的第二數量，以及在另一方面之被包含在該 5 組方程式中之該等第一或第二數量的另外數量之間的一相 異性量測，是較小於再另外的一臨界時，則將該等第一數 量之分別的一數量以及該等第二數量之及時對應的一分別 數量將從欲被解出之該組方程式中予以排除。 如果被包括在方程式組中之該等第一（或第二）數量彼 10 此分離多於一特定距離時，則該等校準參數之精確度被改 良。亦即，該等分別的數量在它們分別的向量空間之一相 同的小區域之内將沒有群集。群集將形成一組近乎奇異的 方程式組。 如果裝置是手持或移動型式，該等校準裝置是可間歇 15 操作的，例如，當更換電池時。另外地，該校準裝置是可 在作為背景處理程序之操作使用中操作。 在進一步的另一實施例中，該第一感測器包括一個2D 磁力計；並且該第二感測器包括一個3D加速計。這組態已 在上面概要地被討論。其之吸引力是在於低成本製作。 20 本發明上面之實施例係關於一實際裝置。本發明同時 也是與商業上相關之用以校準一方位感測系統之方法，以 及關於使用一微處理機以執行此方法之軟體。 圖式簡單說明 本發明將經由範例以及參考附圖而進一步詳細地被說 10 200905166 明，其中： 之 數學:i式3”提供說明本發明中校準處理程序 第2圖是展示本發明中相對於一裝置 5量的圖式； ’叹董力向 第4圖是本發明校準處 處各序中之相關步驟的圖式. 第7圖疋本發明裝置之方塊圖。 ， 全文中所有之圖形，相似或對應的特 考號碼或符號被指示相门的參 1〇字被表示。 在-明中，向量及矩陣量藉由粗體 【實施方式】 較佳實施例之詳細說明 15 、准盤中之磁力計被用來量測地球磁場向旦 量。但是，當利用該磁力計量測時，在磁=之为 材料將影響該磁場。如果是 彳鄰近的鐵磁 自该磁力計的量測，則羅盤之方 办曰來 確。校準是需要以輔hi 角度輸出將不精 +疋而要以補^在量測場上含鐵磁材料 便保持精確度。 利针之衫響，以 20 磁力計供應錢向量麵，其是心 計的—個三維⑽向量，或用於-2D磁力計的' 取磁力 向量。向量MM是關於相對被固定在羅盤上之 ^維） 所參考的3D地球磁場向量。該上標“c”代表“主體，，： = 2主體(body)，，）。對於向量MM之一表示式藉由第i圖令線 矩陣方程式⑽)給予。數量SF_是用於_3d磁力叶之— 200905166 個3x3‘度因子矩陣，或用於一2D磁力計之μ標度因子矩 陣。數量Pmm是用於-3D磁力計之一3D偏移向量，或用於 -2D磁力計之-2D偏移向量。偏移向是磁力計之偏 移以及被固定在該磁力計鄰近中之硬磁材料之結果。硬磁 5材料是具有它們獨有的永久磁場之材料，例如，永久磁鐵。 標度因子矩陣SF_代表有關於上面所提之固定座標系統磁 力計之感測H軸的敏感性以及方位，並且同時也說明磁力計 鄰近軟磁材料在當地的地球磁場強度以及方向上之影響。 地球磁場向量CB在一所給予之位置上具有一常數大 10小。當量測時之向量eB的方向是相對於地球磁場之羅盤方 位的表示。向量eB可假設主體座標框中所有可能的方向。 理想地’在一3D空間中之對應的3D MM向量的座標被平放 在一橢面表面上。同樣地，一 2D空間中之對應的2D MM向 量的座標被平放在利用一橢圓所圍繞之一封閉區域中。 15 在一般的先前技術方法中’假定操作使用中之羅盤僅 圍繞著相同單一軸轉動（通常為垂直軸’其對應至一方位角 轉動）。這轉動軸之方向利用單位長度之一向量。〇被指出。 向量eB同樣也被限制圍繞著轴Ώ轉動。換言之，對於向量 CB之方向僅有一個自由度。因而，對應的2D MM向量可終 20止在一2D空間中一橢圓上。第1圖中之方程式104表示向量 CB可被表示作為第一個常數分量％||，其是平行於轉動軸 ，以及第二個常數長度分量eB丄，是垂直於A之和。第二 分量之坐標長度利用第1圖中之表示式106被給予。向量CB 假定僅圍繞著具有單位向量εΩ之軸轉動的限制，被使用以 12 200905166 表示向量$，如方程式（108)中。於表示式（1〇8)中，向量、 指示被固定在羅盤主體上之座標系統的χ_軸。假定向量 εΩ，不是平行於向量cCx，並且角度^^指示向量％丄圍繞著 轉動軸α轉動離開向量Ccx之角度。這角度α代表所量 5測向量之單一自由度。對於這些向量之一圖式表示，泉 考第2圖，其中特徵部202指示固態羅盤之主體。 以方程式108代入方程式102將導出表示式3〇2。表示式 302顯示平行分量CB||在磁力計之輸出信號向量肘鰓中給予 另一個偏移上升，並且垂直分量$丄依據角度α而形成一變 10 化性之影響。 一2D磁力計之自動校準在於決定利用表示式3〇4所給 予的混合2x2矩陣以及表示式306混合偏移向量之兩個分量 的四個係數。如果角度α自〇前進至2 π，方程式302之向量 ΜΜ在2D平面中形成一橢圓。一般，該2D平面中之一橢圓 15 利用五個獨立參數被說明：其之兩個軸的長度、相對於一 參考座標系統之其方位的一角度表示、以及從該參考座標 系統原點之其2D偏移。因此，如果對於在角度α之不同（未 知的）數值的向量ΜΜ，得到至少有五個量測，則該橢圓之 五個參數可以適合於該等量測。但是，唯一地描述該適合 20 橢圓的五個參數是不足以決定校準模式之六個獨立參數 (2x2矩陣的四個參數加上偏移向量的兩個參數）。該偏移向 量它本身可唯一地被決定作為適合橢圓的中心。該2Χ2矩陣 的四個係數不能唯一地被決定。為了決定該2x2矩陣的四個 係數，角度α之數值必須是也已知供用於五個量測之至少 13 200905166 —個。這最後的步驟被稱為“標頭校準，，並且必須由使用者 進行（手動地）’例如，利用將該羅盤放在一已知的參考方位 中。這標頭校準步驟對使用者是非常不切實際地：該使用 者不能預期地知道正確的參考方位（那是他/她需要這羅盤 5之原因同時該羅盤方位在校準期間（以及正常使用）也需 要在一個單一平面中被轉動之事實是非常不方便的特別 是對於一手持移動式裝置。這校準型式範例將在下面的專 利文件中被給予，其全部將被併入此處作為參考：美國專 利申μ第2004/0267505號案；美國專利申請第4953305號 〇案；美國專利申請第5644851號案；美國專利申請第6047237 鱿案；美國專利申請第6173501號案·，美國專利申請第 6192315號案；美國專利申請第63〇1794號案。 如果磁力計具有一3D功能，則可用的羅盤方位不被限 Η制於圍繞著單一軸轉動。一3D磁力計之自動校準則不被限 制於任個之單一轉動軸。如果地球磁場向量cB之方向變 化則向里MM描述平放在一3D空間中一橢面表面上的一 路徑。該橢面主軸利用3x3矩陣SFmm被決定，因而其之中 心相對於參考座標系統被偏移3 D向量βΜ M。3 D磁力計之自 2 〇動+父準接著用以決定3 x 3矩陣S F M M的九個係數以及向量 〇 的三個分量一般’―橢面唯一地利用九個參數被描 述丄其之三個軸之長度、相對於一參考座標系統之其方位 的二個角度表示、以及相對於該參考座標系統辨識該橢面 I D偏移向量的二個分量。因而，需要向量肘肘之至 ' 同里測以便唯一地能夠使該橢面之參數適合於該 14 200905166 等量測。但是，該適合橢面的九個參數是不足以唯—地決 定校準模式的十二個參數：3x3矩陣SFMM的九個係數以及 偏移向量βΜΜ的三個分量。橢面之中心座標，亦即，偏移向 量βΜΜ，可唯一地被決定。但是，矩陣SF_的九個係數不 5能唯一地使用描述該橢面之其餘的六個參數被決定。接 著，對於該等至少九個河肘量測之至少兩個，向量cB對應 的方向必須是已知的，以便辨識矩陣SF_之係數。因此， 如同在2D的情況中，使用者是進行藉由將羅盤放在兩個已 知的參考方位中之—標頭校準麻煩步驟。 10 在上面背景技術部份中所提及之國際專利申請第 WO02/46693號案，揭示—避免在—3D磁力計中需要_分別 的;^員ic準之自動板準技術。該技術是依據提供用以校準 該磁力計之-參考方向的3D重力感測器（或：3D加速計)之 使用d羅盤必須被保持在差不多平均地被分佈在空間中 15之至少十二個不同的方位中。該習知的技術受限制於一犯 磁力相及-3D加速計之組合。其不能被使用於其中一個 或兩者感測器皆僅是2D之情況中。 在方位感測系統以及傾斜補償式羅盤中，一加速計被 添加以量測地球重力加速度eg之方向。由於。B以及eg皆自量 2〇測被得到’吾人可藉由計算如在第3圖方程式(期）中所給予 的地磁參考座標系統之參考軸線(東，北，上）而決定羅盤方 位。伙这些可計算另外的數量，例如，用於一羅盤之傾斜 補償標頭角度。 如在國際專利申請第WO〇2/46693號案中所揭示，藉由 15 200905166 一加速計之1方向量測同時也可被使用作為用於磁力計模 式之所有參數的自動校準之一參考方向。這是因為在地球 上一所給予位置的向量^和、之間的角度是常數。因此， 用於向量MM各特定量測之方向eg的知識將限定對應的未 5 知向量eB之可能的方向，使成為那些被平放在一圓錐形的 表面上具有平行於eg且相交於圓錐形頂部的一個軸之方 向。這自動校準的方法排除使用者執行一標頭校準步驟之 需要。該羅盤成為完全地自我校準。 在國際專利申請第WO02/46693號案中被揭示之技術 10 專門適用於一 3D磁力計以及一 3D加速計之組合。一 2D磁力 計，相對於一 3D磁力計，具有關於，例如，成本之優點。 但是，該習知的技術，是不可應用於一2D磁力計上。 發明者接著提出另一種適用於一2D磁力計以及一3D 磁力計兩者之磁力計模式參數的自動校準方法。此外，不 15 同於習知技術，本發明中之方法可以用於一2D加速計，以 及也可以用於一3D加速計。此外，依據本發明之另一方法 關於必須採用取樣以校準系統之方位數量以及空間分配的 需求將會更鬆。 國際專利申請第WO02/46693號案之習知的方法最少 20 需要十二個，或最好是十六個不同的方位，其必須以差不 多均勻地間隔分佈，以便完成啟始線性適合之良好的收斂 性。應用本發明方法於具有一 3D磁力計以及一 3D加速計之 羅盤上，用以校準所需的方位之最小數目被降低至七個， 或最好是10個，並且只要沒有方位之聚集，則它們的分佈 16 200905166 是較不重要。這允許使用本發明之方法而不必使用者主動 地涉入。因演算法能夠收集相關的感測器資料在羅盤操作 使用一背景處理程序中，這大大地有益於使用者親和性。 5 10 15 20 第4圖是列出依據本發明一自動校準方法主要步驟之 處理釦序400的圖式。處理程序4〇〇是取決於感測器資料向 量之收集樣本’各個向量包括所有的感測器通道。各被取 樣的感測器資料向量之分別的分量代表在—特定時刻利用 刀別感測$通道之__分mg之感測器輸出信號表示。 ，不同的連續時刻所收集的取樣之平均被計算出。足夠數 量的平均取樣被產生以便能夠實行一適合演算法而決定標 度因子矩陣SF_以及偏移向量βΜΜ之參數。 處理程序在步驟401中被啟始化。收集的取樣數量被設 =。，，平均向量集合大小被設定為零。—異常旗標被設 疋為假。一收集旗標被設定為“假，，…目前參數华八自 -備份部被重新儲存。當收集該樣本時，在步驟術中判定 足夠的樣本是否已經收集以決定—有意義的平均數。如果 尚無足夠的樣本被採取，則在步驟4〇4 得。™判定在羅盤於— 變的一時間週期之期間最新的樣本是否被:主要改 羅盤是否遭受非所需移狀方法是 * —種判定 器通道之資料被比較至通道在各新的14纟自各感測 平均量。如果對於任何感測器通道所得到寺川之正進行的 那通道正進行之平均量多於一預定 的目如取樣偏離 經遭受一主要移動之結論。如果該偏:是=== 17 200905166 步驟408中，正進行之平均量感測器資料向量被更動以便包 括新的樣本並且處理程序400返回至步驟402用以判定下一 個取樣是否為必需的。 如果在步驟406中判定，當採取樣本時已有非所需的移 5 動時，則處理程序400前進至目前樣本被忽略的步驟409 中。在步驟410中判定到目前為止所蒐集的樣本數量是否較 高於一預定最小量。如果該數量是較低於該最小量，則處 理程序400前進至步驟411，其中用以儲存正進行之平均量 的暫存器被重新設定並且樣本數量之變量表示被重新設定 10 為零，隨之處理程序400返回至步驟402。如果蒐集的樣本 數量是較高於該最小量，則處理程序400前進至步驟412, 其中該正進行之平均量則成為限定的平均量。同樣地，如 果在步驟402中判定對於一有意義的平均量之足夠的樣本 數量已被收集，則處理程序400前進至步驟412。 15 在步驟413中，用以儲存該正進行之平均量的暫存器被 重新設定以便能夠開始計算下一個平均量。在步驟414中， 判定限定的平均加速度向量之大小是否充分地接近於重力 向量之大小（標準化）。如果有一充分大的差異，則在步驟415 中該平均量被忽略並且處理程序400返回至步驟402。如果 20 該量測的加速度是可接受的，則處理程序400前進至步驟 416，其中判定該被平均之向量是否與磁力計校準模式之該 目前被設定參數一致。如果沒有充分的一致性，則該異常 旗標被設定為“真”並且在步驟417中，收集旗標被設定為 “真”。該異常旗標指出該最新平均向量是否與目前正使用 18 200905166 中以補償磁力計讀取之參數集合一致。一異常旗標之數值 “假”可在步驟418中選擇地被使用，以確認在本發明電子羅 盤之一使用者界面（圖中未展示出）中所提出之結果的可靠 度。收集旗標為“真”之設定是開始收集平均向量的一種觸 5 發。亦即，一組平均向量之產生在該第一異常被檢測之後 開始。一旦該產生被開始，向量可剛好與目前集合一致地 ' 被添加。在步驟419中判定收集旗標是否為真。如果不是 真，則在步驟420中限定的平均感測器資料向量被忽略並且 { 處理程序返回至步驟402。 10 如果該收集旗標是為真，則在步驟421中判定平均感測 器資料向量是否充分地與先前收集之所有另外的平均感測 器資料向量不同。這可被完成，例如，藉由決定其對各該 先前收集的平均向量之距離是否充分地大。如果該距離是 充分地大，則該目前平均感測器資料向量被添加至該組先 15 前收集平均感測器資料向量中並且在步驟422中該可變的 “集合尺度”被增量。否則在步驟423中該平均感測器資料被 、 忽略，隨之處理程序400返回至步驟402。該距離可以許多 不同的方式被表示，例如，在一尺度等於感測器通道數量 之空間中的歐幾里德距離量測。加權因數可被施加至所比 20 較該等向量之分別的分量上，例如，在一些感測器轴是比 另外轴較為不可靠（更具雜訊）之情況中。對於磁力計信號向 量以及加速計信號向量之距離同時也可分別地被判定。可 接受的相關準則是該等距離之分別的每一個距離是較大於 某一分別臨界。 19 200905166 括 在步驟426中判定因此被收集之該組平均向量是否包 =的向讀目。如果該數目是足夠的，則一適合常 旦 ’驟8 +被執行以給予該組平均感測器 貢料向 人rtr崎的磁力計模式參數。在步驟物中判定該適 ill、疋否以餘數已成為充分地小的方式收斂，因而遭受 10 15 20 向量’是自我相容。如果該常式不收斂， 如…b收集平均向量過程之期間磁性異常地改變。例 二執：自：校準之電子羅盤是暫時地放在一鐵磁物體附 二34可意味著該常式將永不收斂至與該組平均向量各 致的—組校準參數。在那情況中，該組平均向量將 月除，δ亥可變的“集合尺度”重新被設定為零，並且在步 驟432中該參數集合之—備份將被重㈣存，隨之處理程序 彻返回至步驟402。但是，收敛性不（尚未)發生的另-個理 由y旎是，到目前為止所收集的該組平均向量沒攜帶足夠 的貝訊以便使該常式能確實收斂至一組校準參數。在後者 的情況中，收斂性可在收集另外的平均向量之後被達成。 因此，在步驟434中首先判定該可變的“集合尺度，，是否已達 到-預定最大量。如果是，則處理程序4〇〇前進至步驟432 ^ 如果為否，則處理程序4〇〇前進至步驟402以供收集另外的 平均向量。 如果在步驟430中判定該收斂性已發生，亦即，該餘數 是為可接受之小量，則處理程序400前進至步驟436，其中 该叙新的校準參數被釋出以供操作使用。在步驟44〇中，該 目前參數集合被做備份，該可變的“集合尺度，，重新被設定 20 200905166 為零並且该收集旗標被重新設定為“假，，。但是這僅在步驟 438判定具有平均向量為最大數量的收斂性是否已發生之 後被完成。這保障備份參數集合的可靠度。如果該平均向 量的最大數量尚未被達到，當處理程序4〇〇返回至步驟*的 5 時則平均向量之收集繼續。 收斂性測試包括，例如，—均方根適合餘數之計算， 以及其是否較低於一預定臨界位準之測試。 處理程序400之反覆適合常式將不只是包括磁力計資 料向量MMi但是同時也包括加速計資料向量AMi，而不b 10僅用於各種感測器組態之直接地被計算的重力向量。&，$ 中一 2D加速計正以與一 2D或3D磁力計之組合方式被使 用。因此，包含利用一加速計(2D或3D)被量測之向量、的 一表示式藉由公式502被形成，其具有等於表示式1〇2的— 種結構。此處’數量SFAM是標度因子矩陣(在相對於該主個 15 體座標軸之方位中描述敏感性以及精確度）並且βΑΜ是偏移 向量。假定SFAM以及βΑΜ兩者皆已利用一工廠校準程序被 判定。如這步驟之部份，SFAM之標度被選擇以至於向量Cg 之長度被設定為一單位。 接著，考慮自對於羅盤第i個方位之量測MMi及AMi所 20 得到的資訊。取決於該感測器組態（2D或3D磁力計、加速 計），對於各方位i之在四個及六個不同數罝信號之間的樣本 被得到（亦即’一個四至六維度感測器資料向量）。因為各個 方位i具有三個自由度，其不是預知的，三個未知的參數同 時也被引介。這建議各另外的方位之四-至六維度感測器資 21 2〇〇9〇5166 s 料向量 容許原始未知參數之—個、兩個或三個數值的決 值是’在一3D加速計情況中，利用加速計被供應之資 料向曰 ° ®僅允許兩個自由度方向（是為向量Cg之方向）之決 定 。因此’各另外方位之四至六感測器維度資料向量允許 。亥原始未知參數之 一個或兩個數值的決定。 在下面，使用2D或3D磁力計以及2D或3D加速計之不 同1 且合的各種羅盤組態將更詳細地被討論。 10 15 20 第 ''種組態使用一 3D磁力計以及一 3D加速計。於此情 在矩陣SFMM中有9個未知的係數以及在向量βΜΜ中有3 未知的分量，共計有磁力計校準模式之十二個未知的參 對於各方位i，向量义直接地自方程式（502)之倒反的方 程式(5〇4)中被得到。該等磁力計樣本MMi各係關於一對應 的地球磁向量eBi，其具有三個未知的分量。所知的是， 對於所有的方位i其之大小必須是相同（而不是折衷之概括 ’向量eBi長度被設定為一單位），並且對於所有的方位i 其與向量cgi之内 積必須是相同。因此，對於N個方位（或n 個感測器資料向量），一組5N個非線性方程式被得到，如第 5圖中參考號碼(506)之表示。該内積K被考慮為另外一未知 的（純量）常數。因此，在這組5N個方程式中未知數的總數 共計為13+3N :在矩陣SFMM中有9個未知數，在向量βΜΜ中 有3個未知數，在ν個不同的方位中有該未知的内積κ以及 對於向量個量測有3Ν個未知數。如果5Ν<13+3Ν，則 該組方程式具有維度13-2Ν之一連續的解空間。對μΝ>7， 則該解空間是離散(〇維度）。因為該等方程式是非線性，離 22 200905166 散解數量可能是較大於1。簡言之，對於至少7個不同的方 位之感測器資料向量是所需的，以解出該組方程式。n=7 之需求暗示34個未知數之35個純量方程式。 第二種組態使用一 3D磁力計以及一 2D加速計。不同於 5第一種組態，sfam是一非方陣矩陣並且向量cgi不能利用方 程式502之倒反直接地被得到。因此接著該量測向量、是另 外之未知數並且將被解出的該組方程式是利用第5圖中參 考號碼508被指出之一方程式。接著有13+6]^個未知數，並 且純量方程式之數目等於8N。如果8N>13+6N，且因此，如 1〇果^^>7，則該解答空間是離散的。如在該第一組態中，感 測器資料向量是需要來自至少7個不同的方位以解出該組 方程式，其對於# = 7，則包含55個未知數之56個方程式。 第三種組態使用一2D磁力計以及一3D加速計。接著有 8個未知的原始參數被包括在被組合之矩陣S F M M以及向量 15 pMM中。該内積K是第九個未知的參數。相似於該第一組 態，向量cg，可直接地自方程式504被得到。該組方程式結果 如利用第6圖中參考號碼602被指出。接著向量MMi*2D向 里。這組方程式中之未知數總數是9+3N，純量方程式之數 目是4N。如果4N>9+3N，則一離散解空間被得到，其意指 “因此，對於至少9個不同的方位之感測器資料向量是 所需的，以便解出方程式組6〇2。對於N=9，方程式組6〇2 包括36個未知數構成之36個數量方程式。 第四種組態使用一2D磁力計以及一2D加速計。再次 地，有8個未知的原始的參數被包括在被組合的矩陣 23 200905166 以及向量βΜΜ中。内積κ是第九個未知的參數。將被解出之 該組方程式利用第6圖之參考號碼604被給予。接著，在 個數量方程式中有總數為9+6Ν的未知數。如果ν>9則該解 空間是離散的。對於Ν=9，該組方程式以63個未知數構成 5 63個方程式。 應注意的是’在上面所有四種組態中，該等方程式集 合是非常稀疏的，雖然該組方程式維度是頗大的。這是因 為各該等未知的向量eBi以及％僅於少數之方程式出現。兮 稀疏性相當地降低解出該等方程式組之計算複雜性。 10 解答具有N個未知數之一組N個非線性方程式是一種 多維度求根術問題，其是習知為一種不易之數值問題。— 種用於多維度求根術的基本演算法是習知的以“牛頓—拉斐 森”命名之求根術，其是依據計算非線性函數之一種衍生矩 陣（雅可比式-Jacobian)以及使用一反覆處理程序。當其接近 15於該根時，牛頓一拉斐森求根術則具有迅速的（二次方程式） 收斂性，但是當遠離根時其也可能是非常不可靠的。為改 進廣域收斂性性質，一些修改必須被製作（線_搜尋）。這些 是用於多維度求根術之標準技術且為本技術所習知的。 第7圖是本發明之電子裝置7〇〇方塊圖。裝置700是，例 2〇如，一手持裝置，例如，一特定的導航支援或一行動電話 或一個人數位助理。另外地，裝置7〇〇被内建在例如，一運 載工具中，以在運載工具使用期間提供導航援助。裝置700 包括一方位感測系統7〇2，其決定相對於地球磁場以及重力 之裝置700之—方位。為此，系統702具有一磁力計704以及 24 200905166 一加速計706。系統702進一步地具有校準裝置708，其藉由 決定參數所需的數值以校準系統702使系統700能精確地決 定其之方位。該校準處理程序已在上面詳細地討論。校準 裝置708儲存相關的參數值在一記憶體710中以便使它們可 ， 5 供系統700操作所使用。在操作使用中，系統700使用包括 . 標度因子矩陣SFMM以及偏移向量βΜΜ之係數的參數以精確 地決定方位。 校準裝置708可以使用電子電路之硬體被實作。另外 { 地，校準裝置708可以軟體被實作，使用一微處理機以執行 10 該軟體之指令。該軟體可由一供應廠商提供在一實際的載 體上，例如，CD、記憶體卡或積體電路模組。另外地，該 軟體可經由一資料網路，例如，一網際網路被下載，用以 被安裝在依據本發明之一電子裝置上。例如，考慮一行動 電話，由該製造商提供一磁力計以及一加速計，但是不提 15 供軟體以執行本發明之方位感測系統。接著藉由如上市後 增加的或升級之附加費用所得到的軟體，該方位感測功能 可被引動。 因此，本發明之電子裝置具有用以決定裝置方位之一 方位感測系統。該系統包括一磁力計以及一加速計。該系 20 統進一步地具有校準裝置以校準供操作使用之感測系統。 加速計供應被使用以限定將被決定的外界磁場之可能方向 範圍的量測。該校準裝置以數值表示地解出一組方程式並 且是同樣良好地可供用於一2D或3D磁力計與一2D或3D加 速計之組合使用。 25 200905166 【圖式簡單說明3 第1、3、5以及ό圖提供說明本發明中一校準處理程序 之數學方程式； 第2圖是展示本發明中相對於一裝置之地磁及重力向 5 量的圖式； 第4圖是本發明一校準處理程序中之相關步驟的圖式； 第7圖是本發明中一裝置之方塊圖。 【主要元件符號說明】 102-108.··方程式 202···固態羅盤主體 302-308.··方程式 400…校準方法之步驟 502-508···方程式 602-604…方程式 700·.·裝置 702···方位感測系統 704…磁力計 706…加速計 708···校準裝置 710···記憶體 26

Claims (1)

1. 200905166 十、申請專利範圍： 1. 一種具有一方位感測系統的電子裴置，該方位感測系統 用以在該裝置操作使用時決定該裝置之一方位，其中： 該方位感測系統包括： 用以供應代表包括地球磁場向量之感測磁場向量 的第一向量之第一感測器； 用以供應代表包括重力場向量之感測加速度向量 的第二向量之第二感測器；以及 耦合至該等第一及第二感測器並且可操作以校準 供操作使用之該感測系統的校準裝置； 該校準裝置使用該等第二向量以對該裝置多數個 方位之對應的每一方位限定將被決定的地球磁場向量 之對應的一向量之可能方向範圍； 该校準裝置是可操作以數值地解出涉及該等代表 第一向量之第一數量及該等代表第二向量之第二數量 的—組方程式；並且 々該组方程式包含，對於各該等第一數量，一個包括 等於參數矩陣與對應地球磁場向量之矩陣相乘的一 項之對應方程式。 2.=請專利範圍第1項之裝置，其中至衫該等第一數 置是利用第-感測器被供應之多數個第一向量的一平 均置’或至少各該等第二數量是利用第二感測器被供應 之夕數個第二向量的一平均量。 3 .如申請專利範圍第1或2項之裝置，其中該校準裝置是可 27 200905166 細作以排除該等第一向量之一特定向量以及該等第二 向量之及時對應的一特定向量被考慮用以產生該等第 I數量的-特別數量作為該等第—向量之特別向量的 第一平均數量’以及用以產生該等第二數量的—對應特 :數量作為該等第二向量之特別向量的第二平均數 里，並且如果下列條件出現，則終止該特別第一數量之 產生以及該對應的特別第二數量之產生： 該特定第一向量偏離該等特別第一向量之第一平 均數量的-執行形態為超出一第一個臨界之向量距離 時；或 該特定第二向量偏離該等特別第二向量之第二平 均數里的一執行形態為超出一第二個臨界之向量距離 時。 4.如申料圍第卜2或3項之裝置，其中如果該特別 的第二數量具有大小偏離一另外的預定數值多於一另 外的臨界時’職等第—數量之-特定數量以及該等第 二數量之及時對應的一特定數量將從欲被解出之該組 方程式中予以排除。 •如申明專利範圍第卜2、3或4項之裝置，其中如果在_ 方面之分別的第-數量或分別的第二數量，以及在另一 方面之被包含在該組方程式中之該等第一或第二數量 的另外數量之_-相異性量測，是較小於再另外的一 臨界時’則將該等第-數量之分別的—數量以及該等第 二數量之及時對應的一分別數量將從欲被解出之該組 28 200905166 方程式中予以排除。 6.如申請專利範圍第1、2、3、4或5項之裝置，其中在該 裝置操作使用期間該校準裝置是可在一背景處理程序 中操作。 5 7.如申請專利範圍第1項之裝置，其中： 該第一感測器包括一個2D磁力計； 該第二感測器包括一個3D加速計； 該組方程式包括首先在申請專利範圍第1項中提及 的方程式、指定該等多數個方位的對應每一方位之地球 10 磁場向量大小的第二方程式，以及指定該等多數個方位 的對應每一方位之地球磁場向量與重力場向量内積之 數值的第三方程式。 8. —種可操作以決定一系統方位之一方位感測系統的校 準方法，其中該系統包括用以供應代表包含地球磁場向 15 量之感測磁場向量的第一向量之第一感測器；以及用以 供應代表包括重力場向量之感測加速度向量的第二向 量之第二感測器；其中該方法包括下列步驟： 使用該等第二向量以對該系統多數個方位之對應 的每一方位限定將被決定的地球磁場向量之對應的一 20 向量之可能方向範圍；並且 數值地解出涉及該等代表第一向量之第一數量及 該等代表第二向量之第二數量的一組方程式，其中該組 方程式包括，對於各該等第一數量，一個包括等於一參 數矩陣與對應地球磁場向量之矩陣相乘的一項之對應 29 200905166 方程式。 •如申4專利範圍第8項之 — 去其包括至少平均該等第 二讀個向量以形成該第-數量或平均該等第 。里之夕數個向量以形成該第二數量。 =請軸賺綱咖，偷騎該等第- 特特定向量以及該”二向量之及時對應的-特疋向置被考慮用產 10 15 作4第一數量的-特別數量 以=㈣—向#之特別向量的第—平均數量，以及用 =生該等第二數量的—對應㈣數量作為該等第二 :里之特別向$的第二平均數量，並且如果下列條件出 ，則終止該特別第—數量之產生以及該對應的特別第 —數量之產生： h該特定第一向量偏離該等特別第一向量之第一平 均數量的-執行形態為超出一第一個臨界之向量距離 時；或 該特定第二向量偏離該等特別第2向量之第二平 均數量的一執行形態為超出一第二個臨界之向量距離 時。 々申明專利範圍第8、9或10項之方法，包括如果該特別 的第一數里具有大小偏離一另外的預定數值多於一另 外的臨界時，則該等第—數量之—特定數量以及該等第 —數量之及時對應的一特定數量將從欲被解出之該組 方程式中予以排除。 12·如申請專利範圍第8、9、10或Η項之方法，其包括如果 30 200905166 在一方面之分別的第一數量或分別的第二數量以及在 另一方面之被包含在該組方程式中之該等第一或第二 數量的另外數量之間的-相異性量測’是較小於再另外 的-臨界時，則將該等第-數量之分別的—數量以及該 等第二數量之及時對應的一分別數量將從欲被解出之 该組方程式中予以排除。 13.如申料利範圍第8、9、1G、1UiU2奴方法其可操 作以在該系統操作使用期間作為一背景處理程序之操 作。 ’、 10 15

   20 M·-種用以校準可操作以決定—⑽方位之—方位感測 ^統的軟體’其中該系統包括用以供應代表包含地球磁 場向量之感測磁場向量的第_向量之第_感測器；以及 用以供應代表包括重力場向量之感测加速度向量的第 一向里之第二感測器；並且其中該軟體包括： 用以使用該等第二向量以對該系統多數個方位之 對應的每一方位限定將被決定的地球磁場向量之對應 的一向量之可能方向範圍的指令；以及 用以數值地解出涉及該等代表第一向量之第一數 量及該等代表第二向量第- 一 ^ J里及弟—數董的—組方程式的指 令，其中該組方程式包括，對於各該等第—數量一個 包括等於-參數矩陣與對應地球磁場向量之矩陣相乘 的一項之對應方程式。 其包括用以產生各該等 或第二感測器供應之多 15.如申請專利範圍第]4項之軟體， 第一或第二數量作為利用第一 31 200905166 數個第一或第二向量之指令。 16.如申清專利範圍第14或15項之軟體其包括指令，供用 於排除該等第一向量之-特定向量以及該等第二向量 之及日守對應的-特定向量被考慮用以產生該等第一數 量的一f別數量作為該等第一向量之特別向量的第一 Γ均數量，以及用於產生該等第二數量的—對應特別數 置作為該等第二向量之特別向量的第二平均數量，並且 如果下列條件出現，則終止該特別第-數量之產生以及 該對應的特別第二數量之產生： 該特定第-向量偏離該等特別第一向量之第一平 均數量的一執行形態為超出一第一個臨界之向量距離 時；或 該特定第二向量偏離該等特別第二向量之第二平 句數置的-執订形態為超出一第二個臨界之向量距離 時0 π.如申4專魏圍第丨4、丨5或10項之軟體，其包括指令， 用於當如果該特別的第二數量具有大小偏離—另外的 敢數值多於-另外的臨界時，則該等第—數量之—特 疋數置以及該等第二數量之及時對應的一特定數量將 從欲被解出之該組方程式中予以排除。 A如申請專利範圍第14、15、16或17項之軟體其包括指 令’用於當如果在-方面之分別的第—數量或分別的第 =數ϊ，以及在另一方面之被包含在該組方程式中之該 等第一或第二數量的另外數量之間的一相異性量測，= 32 200905166 較小於再另外的一臨界時，則將該等第一數量之分別的 -數量以及該等第二數f之及時對應的—分別數量將 從欲被解出之該組方程式中予以排除。 19·如申請專利範圍第14 17 固州15、16、17或18項之軟體 括用以在該系統操作使用期間進行在^ 中之校準的指令。 “、處理裎序 33