TW201243334A - Position estimating method and positioning system using the same - Google Patents

Description

201243334 六、發明說明： 【發明所屬之技術領域】 本發明係指-種定位估測方法及相關定位系統，尤指一種可提 升可靠度之定位估測方法及相關定位系統。 【先前技術】 三維空間（ThreeDimension ’ 3D)定位_已被廣泛使用在各 種電子產品的朗巾，習知蚊财式通料顧_以上不同的 慣性感測器互相搭配來達到物體定位的效果。然而，由於不同種類 的慣性感測ϋ會有不同的反應速度’反應時間當織之不同，如此 來，各’丨貝性感測器的机5虎輸出時間將不易達到一致。舉例來說， 若陀螺儀的侧_絲度1/72G秒，而重力感測器為每度1/16〇〇 秒’在此情況下，將造成物體在某_位置的定位資訊係由不同時間 的感測讯號所估算出來的而產生錯誤的定位結果。 另一方面，由於慣性感測器通常係在運動狀態(時間連續)下進行 感測也就疋說，感測§孔號係透過對時間積分運算所推算出的訊號 值。再者，通常慣性感測II本身會存在有些許的感測誤差，在此情 況下，隨著時間的增長，感測誤差也隨者時間不斷的累積，因此， 時間越久則所造成的誤差透過積分運算所得到的數值也更加龐大， 如此一來，若將慣性感測器使用在長時間的感測運用中，將會產生 不準確的感測結果。 【發明内容】 因此’本發明之主要目的即在於提供一種定位估測方法及相關定 201243334 位系統。 本發月揭％種疋位估測方法，用於具有複數個慣性感測器之— 定位系統’其中該複數個慣性感測H麟置於-物體上，該定位估 測方法有彻5峨數個慣性感測器感測該物體之運動狀態，以 產生複數個_訊號；根據—容錯臨限值，自該複數個感測訊號中 選取出。於誤絲_之概健選_訊號；以及娜該複數個 候選感測訊號，計算出該物體之一估測位置。 本發明另揭露-種定位系統’用來估測出—物體之位置，其包含 有複數個雜_器、—訊號處理單元及—位置運算單元。該複數 個慣性感測器，設置於該物體上，用來感測該物體之運動狀態，以 產生複數個_峨。該域處理單元包含有—賴接收單元及一 容錯偵測單元。該訊號接收單元，輕接於該複數個慣性感測器，用 來接收該複數個感測訊號。該容錯彳貞測單元，輸於親號接收單 元^來根據-容錯臨限值，自職數個感義財選取出合於誤 差範圍内之複數個候選感測訊號。該位置運算單元，輕接於該容錯 翻單元’帛綠獅減鋪贼測减，計算&雜體之 測位置。 【實施方式】 請參考第1圖，第1圖為本發明實施例之一定位系統1〇之示意 圖。定位系統10用來估測出一物體〇B之位置。定位系統包2 有慣性感測器IS1〜IS3、一訊號處理單元1〇2、一位置運算單 104。慣性感測器IS1〜IS3係分別被設置於物體〇B上，用來感則 物體OB之運動狀態，以產生感測訊號S1〜S3 ^訊號處理單元 201243334 包含有-訊號接收單元1G6、—容錯_單元⑽及—歸零重置單 元11〇。訊號接收單元搞接於慣性感測器⑻〜脱，用來接收感測 訊號S1〜S3。容錯_單元⑽搞接於訊號接收單㈣6， 據-容錯臨限值’自感測訊號感測訊號S1〜s3中選取出合於 範圍内之複數個候選感測訊號。歸零重置單元則 性感 器1S1〜1S3與容錯偵測單元應，用來控制慣性感測器⑻^ 以執行-歸_纽料。健運料元_接 元1〇8,用來根據所選擇出之候選感測訊號，計算出物體0B之古 測位置。換言之，梅統料估购峨= 對應位置，如此-來，若透過定位系統職物 間之位置後，即可決定出於不冋時 關於定位系統10的詳細操作方式，請繼續 考第2圖’第2圖為本發明實施例 下說月。Μ參 包含有下列步驟： 机程2〇之示意圖。流程20 步驟200 :開始。 步驟202:_雜_請〜133_物 以產生感測訊號si〜S3。 之運動狀態， 步驟204 :根據容錯臨限值， 誤差範較概她地出合於 步驟206 .根據所選取出候選感剛訊號 測位置。 畔异出物體OB之估 步驟208 :結束。 根據流程2G ’魏，分洲_ 获貝jiUSl〜IS3來感測物體 201243334 〇B之運動狀態，並據以產生感測訊號以〜幻（步驟2〇2)。由於慣 性感測器可能會因長時間所累計的感測誤差或設置位置的影響，甚 至可能是發生故障的關係，而導致產生不正痛的感測訊號。在此情 況下，容錯彳貞測單元可對訊號接收單元1〇6所接收到之感測訊 號S1〜S3進行分析篩選，以根據一容錯臨限值，自感測訊號Sl〜 S3中選取出合於誤差範圍内之候選感測訊號（步驟2〇4)，接著，位 置運算單元104再根據所選擇出的候選感測訊號，來計算出物體 之估測位置（步驟206)。換言之，本發明運用容錯設計之方式來排 除不當(超出容許誤差範圍）的感測訊號，以提升位置估測的可靠 度’進而能獲得更準確的物體定位資訊。 進-步說明，在步驟204中，容錯制單元1〇8可將全部的感測 訊號區分為候職取贼異常_職。也就是說，容錯偵測單 兀⑽可根據容錯臨限值’將感測訊號31〜幻中合於誤差範圍内 之感測訊號選擇作為賊制訊號，以提供_物齡置估測運 算。同時，將超出誤差範圍之感測訊號選擇作為異常感測訊號，而 不再作為後續物體位置估測運算之數據。舉例來說，請參考第3圖， 第3圖為第i圖中之感測訊號S1〜S3之訊號波形圖。假設容錯臨 限值為TH ’且在時間點T時，慣性感測器脱因為感測異常而產 生超出誤差範圍許多之感測訊號S3時，如第3圖所示，在時間點τ 時’慣性感測器IS3所感測出之感測訊號S3的訊號值與相鄰的慣性 感測器IS2所感測出之感測訊號S2的訊號值之間存有很大的差異。 因此’在步驟204中’容錯_單元⑽τ比較每一感測訊號與其 相?#償性感测器所對應之感測讯號，以計算出相對應之訊號差異 201243334 值’當所計算出之訊號差異值小於容錯臨限值TH(亦即合於誤差範 圍内）時，容錯偵測單元108將此感測訊號選為候選感測訊號。同 理，當所計算出之訊號差異值不小於容錯臨限值TH(亦即超過誤差 範圍)時，將此感測訊號選為異常感測訊號。換言之，容錯偵測單元 ⑴8可選擇感測訊號S1與S2作為候選感測訊號sa與sc2，並將 感測訊號S3設定為異常感測訊號SAB1。接著，在步驟2〇6中，位 置運算單元104便僅根據候選感測訊號SCI與SC2，來計算物體 〇B之估測位置而能避免不當的數據來影響物體〇B之位置估測。 -此外由於各十貝性感測器係設置於同一物體上，且正常的感測器 在同-時間點所感測到的感測訊號值通常不會差異太大。因此，容 錯偵測單元108亦可透過比較每一感測訊號與其他感測訊號之訊號 平均值，來計算出相對應的訊號差異值。當所計算出之訊號差異值 小於容錯臨限值時，容錯偵測單元1〇8可將相對應 選 f感測峨，，⑽級峨總術容錯臨= 時，則將相對應的感測訊號選為異常感測訊號。 訊H面资在步驟-204中，當容錯偵測單元108選擇出異常感測 “ 4置單70 110可控制對慣性感測！ IS1〜IS3，執行一 =重置處理程序。舉例來說，透過歸零重置單元ιι〇之控制，慣 IS1〜IS3會於一歸零重置處理週期内暫時停止感測程序， :來，針對感測出異常_訊號之慣性感測ϋ來說，將可改善 =:’在後續的感測過程中，經過歸零重置處心 感測器因長時間所累計的感測誤差而導致產生不正顧感^號償性 201243334 即使定位系統10中之慣性感測器沒有產生超出誤 隔-特定獅，依稍舰 處理程序，如此—來，相當於將_麵計算，在短 y曰内對物體位置估測做—次重置運算，而可消除因時間所 感測誤差，以預防不正確感測訊號的發生。 步驟2G6 _，位置運算單元iG4係根據所選擇出的候選 感測减，來計算出物體0B之估測位置。例如，位置運算單元⑽ 可计异所選擇出之候選感測訊號之平均值，以決定出物體0B之估 測位置。由於慣性感測器IS1〜IS3係設置於物體0B上之不同位 置相對也《測靈敏度也會有所不同。因此，位置運算單元川4 賴據-權重分配_，對所選擇㈣候選感測訊號進行加權運 定出物體0B之估測位置。較佳地，前述權重分配比 例係相對應於各相對應慣性感測器之設置位置，例如敏感度越小的 小的權重，反之亦然，如此一來，針對各慣性感測器的 LUr而給予不同的權重的方式，將可消除敏感度不均的影 響，進而增加三維空間位置估測的可靠性。 值得h的疋’上述的例子僅為用來說明本發明之應用，並非本 =之=制條件’熟知此項技藝者應可了解，在不違背本發明之精 L聰人2圖之机程巾的步驟可再增加其他的巾間步驟、可將數個 步^併成單-步驟或是可省略部分步驟，以做適當之變化。當然， 2可传到大致相同的結果，則第2圖中的之流程20並非限定要依 圖中所不之順序來執行。此外，定位系統1G係為本發明之-包例本7貝域具通常知識者當可據以做不同之變化 。舉例來說， 201243334 訊號接收單元1G6可透過無線或有線方式來連結至慣性感測器IS1 〜1S3以取得相對應之感測訊號。同理，歸零重置單元110亦可透 過無線或有線方式來與慣性感測器IS1〜IS3進行聯繫，以控制相對 應之慣性感測器進行歸零重置處理。此外，本發騎述之慣性感測 器不拘於任何種誠數量，凡是能提供物體運動之細物理量資訊 的4置S翻。舉例來說，無論是三軸加速感㈣、重力感測器、 陀螺儀或電子雜料屬本發明可朗之料，但抑此為限。 以下進-步以應用於-電子筆為例來說明，請參考第4圖，第4 圖為第1圖之定位系統1()應用於一電子筆時之一示意圖。假設物體 ㈤為-電子筆，慣性感測器IS1〜IS3分別為一三轴加速感測器， 容錯臨限值為TH。當使用者欲透過操作物體〇B來進行立體綠圖 時’透過定位系統10之運作將可估測出物體〇8於不同時間之位 置，如此-來，即可決定出物體0B之運動軌跡，而能實現繪圖的 目的。詳細來說’首先，可利用慣性感測器⑻〜脱來感測物體 〇B之運動狀態，並據以產生感測訊號S1〜S3。例如，在時間τ時， 感測訊號S1之喊值為⑶，幻，Z1)，_峨％之訊號值為 (乂2，丫2,22)，感測訊號83之訊號值為（幻，¥3,23)。接著， 利用容錯偵測單元i㈣各感測訊號與其相鄰慣性感測器所對應之 感測訊號進行比較。若_碱S1與S2間之峨差紐小於容錯 臨限值TH且感測訊號S3與S2間之訊號差異值大於容錯臨限值曰 TH，容錯伽，麻可選擇感測訊號S1與幻作為候選感測訊號 SCI與SC2 ’並將感測訊號S3設定為異常感測訊號s·。接著， 位置運算單it 1G4便可依據候選感測訊號SC1與SC2，來計算 201243334 OB之估測位置。當然，由於感測訊號S3之數據已超出容許誤差範 圍，因此，將會被排除而不作為位置計算的基礎。此外，由於慣性 感測器IS1較靠近筆域，制敏感度可能較大，因此給予較大的 權重比例。舉例來說，候選感測訊號SC1與SC2所對應的權重比例 分別為W1與W2，其中W1大於W2，若物體〇B在時間τ時之估 測位置為座標值（X，γ，z)，則χ= (W1*X1) + (製*幻）， Y= (W1 *Y1) + (W2*Y2)，z= (W1*Z1) + (W2*Z2)。此外 由於存在了異常感測1罐^扁，歸零重置單元11〇將會根據異常 感測訊號SAm ’來控制對慣性感測器IS1〜IS3執行歸零重置處适 程序’重新進行時間積分運算，如此—來，制出異常感測訊號 SAB1之慣性感測器IS3將可據以消除原先運作時所累計的感測誤 差。換言之’定位系統丨〇除了能摒除不正確的感測訊號，避免影笔 正確位置的估測之外，更能對存有累計誤差的慣性感測器進行歸零 重置處理程序，使其在後續的感測過程中，可再度正麵感 的運動狀態。 〇综上所述，本發明運用容錯設計之方式來排除不正確的感測訊 ，’而能有魏提升位置估_可靠度。另―方面，本發明更結含 ^零重置處理來消除慣性感測器之累計誤差，並且針對各慣性感濟 =的设置位置;給予*_權重的方式，以消除敏感度不均的 影響，進而獲得更準確的物體定位資訊。 以上所述僅為本發明之較佳實施例，凡依本發明申請專利範圍 所做之均等變化與修飾m本發明之涵蓋範圍。 【圖式簡單說明】 10 201243334 第1@為本發明實施例之—定位系統之示意圖。 第2圖為本發明實施例之一流程之示竟圖。 第3圖為第1圖中之感測訊號之訊號波形圖。 第4圖為第1圖中之定位系統應用於電子筆時之示意圖 【主要元件符號說明】 10 定位系統 102 訊號處理單元 104 位置運算單元 106 訊號接收單元 108 容錯偵測單元 110 歸零重置單元 20 流程 200、202、204、206、 208 步驟 IS1〜IS3 慣性感測器 OB 物體 S1 〜S3 感測訊號 SAB1 異常感測訊號 SCI 〜SC2 候選感測訊號

Claims (1)

1. 201243334 七、申請專利範圍： 1. -種定位估測方法，用於具有複數個慣性感測器之m系統， =該複數贿性劇H係設置於—物虹，奴⑽測方法包 利用該複數個慣性感測器感測該物體之運動狀態，以產生複數個 感測訊號； 根據-容錯錄值，自該概_測職帽取出合於誤差範圍 内之複數個候選感測訊號；以及 根據該複數個候選感測訊號，計算出該物體之一估測位置。 2·如請求項丨所述之定位_方法，其中根據該容錯臨限值，自該 複數個感測訊號中選取出合於誤差範圍内之複數個候選感測訊 號之步驟包含有： 針對每一感測訊號’比較每一感測訊號與其相鄰慣性感測器所對 應之感測訊號，以決定出一訊號差異值；以及 當該訊號差異值λ!、於該容錯鎌辦’選職相職之感測訊號 作為一候選感測訊號。 «% 如π求項1所述之疋位估測方法，其中根據該容錯臨限值，自該 複數個感測訊號中選取出合於誤差範圍内之複數個候選感測訊 號之步驟包含有： 針對母一感測讯號’比較每一該感測訊號與其他感測訊號之一訊 號平均值，以決定出一訊號差異值；以及 當該訊號差異值小於該容錯臨限值時，選擇該相對應之感測訊號 12 201243334 作為一候選感測訊號。 4·如請求項1所述之定位估測方法，其中根獅容錯臨限值，自該 複數個感測訊號中選取出合於誤差範圍内之複數個候選感測訊/ 號之步驟另包含有： ' 將該複數個感測訊號中沒有被選取為候選感測訊號者，選擇作為 一異常感測訊號；以及 當存在有該異常感測訊號時’對該複數個慣性制^，執行一歸 零重置處理程序。 5. 如請求項4所述之定位估測方法，其巾當存在有該異常感測訊號 時’對該複數個慣性感測器，執行該歸零重置處理程序之步驟包 含有： 於-V零重置處理週期内，停止利用該複數個慣性感測器感測該 物體之運動狀態。 6. 如明求項1所述之定位估測方法，其中根據該複數麵選感測訊 號，计算出該物體之該估測位置之步驟包含有： 根據-權重分配比例’對該複數個候_測訊號進行加權運算， 並據以決定出該物體之該估測位置。 7. 明求項6所述之定錄财法，其巾該觀分配_係相對應於 該複數個慣性感測器之位置。 8·如请求ί員1所述之定位估測方法，其中根據該複數個候選感測訊 號’ a十算出该物體之該估測位置之步驟包含有： 什算出a玄複數個候選感測訊號之一平均值，以決定出該物體之該 估測位置。 13 201243334 9. 如請求項丨所述之定位估測方法，其另包含有： 每隔一特定週期，依序對該該複數個慣性感測器，執行一歸零重 置處理程序。 10. —種定位系統，用來估測出一物體之位置，包含有： 複數個慣性感測ϋ ’設置於該物體上，用來感測該物體之運動狀 態’以產生複數個感測訊號； 一訊號處理單元，包含有： -訊號接收單元’触於該複數個慣性感測器，用來接收該 複數個感測訊號；以及 一容錯偵測單元，耦接於該訊號接收單元，用來根據一容錯 臨限值，自該複數個感測訊號中選取出合於誤差範圍内之 複數個候選感測訊號；以及 -位置運算單元，搞接於該容錯偵測單元，用來根據該複數_ 選感測訊號’計算出該物體之一估測位置。 11. 如請求項10所述之定位系統，其中該容錯偵測單元比較每一慣 性感測器所感測到之感測訊號與其相鄰慣性感測器所對應之感 測訊號，以決定出一訊號差異值，並於該訊號差異值小於該容錯 臨限值時，選擇該相對應之感測訊號作為一候選感測訊號。 12. 如請求項1〇所述之定位系統，其中該容錯偵測單元比較每一慣 性感測器所感測到之感測訊號與其他慣性感測器所對應之感測 訊號之一訊號平均值，以決定出一訊號差異值，並於該訊號差異 值小於該容錯臨限值時’選擇該相對應之感測訊號作為一候選感 測訊號。 201243334 13.如請求項1G所述之定位系統，其中該容錯_單元將該複數個 感測訊號中沒有被選取為候選感測訊號者，選擇作為一異常感、則 訊號 14.如請求項10所述之定位系統，其中該訊號處理單元另包含有： 一歸零重置單元，耦接於該複數個慣性感測器與該容錯偵測單 元，用來控制對該複數個慣性感測器，執行一歸零重置處理 程序。 15·如請求項14所述之定位系統，其中該歸零重置單元係於一歸零 重置處理週期内’控制該該複數個慣性感測器停止感測該物體之 運動狀態。 16.如睛求項14所述之定位系統，其中該歸零重置單元每隔一特定 週期’依序對該該複數個慣性感測器，執行一歸零重置處理程序。 Π.如請求項10所述之定位系統，其中該位置運算單元根據一權重 分配比例’對該複數個候選感測訊號進行加權運算，並據以決定 出該物體之該估測位置。 18. 如請求項π所述之定位系統，其中該權重分配比例係相對應於 該複數個慣性感測器之位置。 19, 如請求項10所述之定位系統，其中該位置運算單元計算出該複 數個候選感測訊號之一平均值，並據以決定出該物體之該估測位 置。 20. 如請求項1〇所述之定位系統，其中該複數個慣性感測器係分別 為一三軸加速感測器、一重力感測器、一陀螺儀或一電子羅盤。 21. 如請求項1〇所述之定位系統，其中該複數個慣性感測器係分別 15 201243334 設置於該物體之不同位置。 、圓式· 16