TWI457538B - 用於慣性量測單元(imu)的空間校準決定的方法、儲存媒體及設備 - Google Patents

用於慣性量測單元(imu)的空間校準決定的方法、儲存媒體及設備 Download PDF

Info

Publication number
TWI457538B
TWI457538B TW099140046A TW99140046A TWI457538B TW I457538 B TWI457538 B TW I457538B TW 099140046 A TW099140046 A TW 099140046A TW 99140046 A TW99140046 A TW 99140046A TW I457538 B TWI457538 B TW I457538B
Authority
TW
Taiwan
Prior art keywords
imu
vehicle
acceleration
derived
coordinate system
Prior art date
Application number
TW099140046A
Other languages
English (en)
Other versions
TW201139987A (en
Inventor
Joseph Czompo
Original Assignee
Qualcomm Inc
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
Application filed by Qualcomm Inc filed Critical Qualcomm Inc
Publication of TW201139987A publication Critical patent/TW201139987A/zh
Application granted granted Critical
Publication of TWI457538B publication Critical patent/TWI457538B/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/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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • G01S19/49Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Description

用於慣性量測單元(IMU)的空間校準決定的方法、儲存媒體及設備
本文中所揭示的標的係關於決定慣性量測單元(IMU)的空間校準。
導航輔助長期以來對於商業和旅行是重要的。幾百或幾千年中,旅行者不得不依賴於紙質地圖或友好陌生人的口頭指引來發現其通往給定目的地的路線。相反,過去幾十年開發出了電子導航輔助。由於其原始大小、費用及複雜性,其起初主要由軍隊、其他政府實體,以及大型公共運輸業者(諸如遠洋班輪和飛機之類)使用。然而,近期有一些電子導航輔助已變得更小、更便宜且使用起來更簡單。因此,其已可供更廣大的民眾使用。
相比於傳統的導航輔助,電子導航輔助可更加容易地使其導航資訊保持時新,可提供更大量的導航資訊,可提供先前不可能的附加特徵,等等。例如,現代導航輔助可以能夠提供可包括但不限於以下各項的許多導航有關特徵中的任何特徵:提供大致指引、標繪出發點與目的地之間的路線、顯示地圖、呈現所謂的路口轉彎(turn-by-turn)指引、記錄已行進的路徑、其組合、等等。
示例性類型的電子導航輔助使用衛星定位系統(SPS)結合慣性導航系統(INS)。此種有時被稱為SPS-INS導航系統的類型的電子導航輔助使用IMU。為了操作此類SPS-INS導航系統,IMU相對於地心地固(ECEF)座標系的空間校準要被決定到某個精度位準。
如以上指出的,一些導航輔助實施在相對較小的封裝中,包括能夠由個人攜帶的一些設備。亦可以使此類可攜式設備充分便宜從而讓許多人認為能負擔得起。遺憾的是,已為具有導航輔助有關特徵的設備實施的大小和成本縮減可能產生負面結果。更特定言之,此類設備決定充分準確的IMU空間校準的能力一般較弱。因此,在某些情況下,將此類設備與SPS-INS導航系統聯用可能是困難的、麻煩的,或甚至是不可能的。
在示例性實施中,提供了一種方法,其中識別第一基於車輛的方向,並且將第一基於車輛的方向與能變換到基於地球的座標系的第一方向相關聯。至少部分地基於該第一方向來決定IMU的空間校準。然而應瞭解,其僅是示例性實施,且其他實施在本文中作了描述且可被採用而不會脫離所主張的標的。
貫穿本說明書引述的「一個實例」、「一個特徵」、「實例」、「一特徵」等意謂結合該特徵及/或實例所描述的特定特徵、結構、特性等與所主張的標的的至少一個特徵及/或實例有關。因此,貫穿本說明書各處出現的諸如「在一個實例中」、「實例」、「在一個特徵中」、「特徵」等用語不一定全部代表相同的特徵及/或實例。此外,特定特徵、結構、特性等可在一或多個實例及/或特徵中被組合。
如以上指出的,可決定IMU相對於ECEF座標系的空間校準以促進SPS-INS導航系統中的INS-SPS組合導航。IMU的空間校準可用與重力和與地球旋轉有關的兩個向量來決定。前者可用加速計來偵測,而後者可用相對高品質的陀螺儀來偵測。然而,目前使用的使導航輔助能更緊湊且較不昂貴的技術中之一者涉及微機電系統(MEMS)感測器。遺憾的是,此類MEMS感測器中的固有雜訊淹沒了對地球旋轉的更精細量測。因此,地球旋轉用當前的MEMS感測器可能無法偵測。
作為決定IMU的空間校準的另一種可能辦法,可使IMU感測器系與其所耦合到的車輛的實體結構實體地校準。此舉使得能在由IMU感測器系偵測到的前向加速度與(例如,可基於經由諸如SPS之類的另一導航裝置及/或系統提供的速度資料的)前向速度資訊之間引起對應關係。遺憾的是,其可能使得必須將容納IMU的設備附著在車輛特定的預定位置。儘管此辦法對於與車輛整合的導航輔助而言可能是可接受的辦法,但對於提供導航輔助特徵的可攜式設備而言即使可實行其可接受程度亦低得多。此辦法對於除導航以外亦包括許多其他特徵(例如,諸如通訊)的行動站而言尤其是不可接受的,因為使用者很可能時常在下車之後將該行動站從車輛移走。
然而,實驗已揭示了近似校準通常足以啟動SPS-INS導航系統。在啟動之後,可在SPS-INS組合導航期間使用來自SPS的資訊來解析校準角的改進值。IMU的空間校準的決定可基於以下原理:若ECEF座標系中已知的向量能被IMU量測到,則該等向量能被用來推導IMU與ECEF系之間的空間關係。
對於MEMS IMU系統,例如,其意謂或許不可能對駐定系統執行完全校準,因為在駐定期期間,可觀察量是重力。此舉留下了一個未決定的自由度。另一方面,在運動的平臺上量測到的重力由於宿主平臺的伴隨加速度因而具有降級的準確性。其產生了固有矛盾,該固有矛盾可藉由在系統駐定時量測重力並隨後決定IMU與非零SPS速度的空間校準來解決。該辦法的缺點是雙重的:首先,重力方向和SPS速度方向並不嚴格對應於同一校準,因為其被時間和空間所分隔開;第二,為了使該辦法起效,IMU的選定軸仍以已知方式與SPS速度方向實體地校準。
另一方面,對於某些示例性實施,不需要假定在導航通信期開始是駐定狀態或者IMU軸相對於車輛或相對於ECEF系有任何特定校準。作為代替,當正在(例如,使用諸如SPS之類的導航有關裝置及/或系統)量測車輛速度時可使IMU的實體校準及/或容納IMU的設備的實體校準相對於車輛保持恆定。某些示例性實施是基於在IMU座標系中量測在基於地球的座標系中已知的或至少可變換到基於地球的座標系中的向量。例如,可將車輛有關運動資料與一或多個測得加速度相關以識別一或多個基於車輛的方向。此類基於車輛的方向可與可變換到基於地球的座標系的方向相關聯。
圖1是根據一實施的其中可用IMU 102和SPSU 104來實施SPS-INS導航系統的示例性環境100的方塊圖。如所圖示的,示例性環境100包括IMU 102、SPSU 104、行動站106、底座108、車輛110、衛星112和導航圖符114。在一實例中,行動站106可包括IMU 102和SPSU 104。行動站106可以可拆卸地緊固到底座108。底座108可以固定地緊固於車輛110。車輛110能夠繞地球、在地球上、在地球上方等運動,如導航圖符114所指示。可由涉及一或多顆衛星112的SPS結合至少SPSU 104來促進導航。
行動站106可替代地被(可拆卸地或永久地)耦合到IMU 102及/或SPSU 104(例如,作為實體上附接的或無線地耦合的單獨模組)。行動站106可包括任何包含導航輔助有關特徵的可攜式設備。行動站106可實施為智慧型電話、行動電話、行動終端、個人數位助理(PDA)、個人資訊管理器(PIM)、個人導航設備(PND)、所謂的小筆電、膝上型電腦或筆記型電腦、娛樂設施(例如,媒體播放器、遊戲機等)、專用導航設備、其某種組合、等等,此處僅列舉了少數實例。下文特別參看圖12來描述包括IMU 102和SPSU 104的可以能夠接收無線通訊及/或導航信號並提供導航特徵的一般性設備。
在示例性實施中,底座108可以固定地(但永久地或者可拆卸地)附接於車輛110。底座108可被適配成接納行動站106並將行動站106緊固至底座108。因此,行動站106經由底座108緊固成與車輛110呈固定關係。該佈置使得使用者在離開車輛110時能方便地帶走行動站106,而在車輛處於運動中時仍保持行動站106相對於車輛110固定。或者,可在不使用底座108的情況下維持行動站106相對於車輛110呈恆定實體校準(例如,藉由使用將行動站106直接耦合到車輛110的其他某種機制、藉由手動保持其就位等)。
本文中描述的示例性實施可與各種SPS聯用。實例包括,但不限於,美國全球定位系統(GPS)、俄羅斯Glonass系統、歐洲Galileo(伽利略)系統、任何使用來自衛星系統的組合的衛星的系統、任何在將來開發的衛星系統等等。此外,本文中描述的實施可隨同利用偽衛星或者衛星與偽衛星的組合的定位決定系統一起使用。偽衛星一般是廣播被調制在L頻帶(或其他頻率)載波信號上的假性隨機雜訊(PRN)碼或其他測距碼(例如,類似於GPS或CDMA蜂巢信號)的基於地面的發射機,該載波信號可以與GPS時間同步。每一個此種發射機可以被指派唯一性的PN碼從而准許其被遠端接收機識別。偽衛星在其中來自軌道衛星的GPS信號可能不可用的境況中尤其有用,諸如在隧道、礦區、建築、市區都市街道或其他封閉地區中。偽衛星的另一種實施被稱為無線電信標。如本文中所使用的術語「衛星」意欲包括偽衛星、偽衛星的均等物,以及相似及/或類似技術。如本文中所使用的術語「SPS信號」意欲包括來自偽衛星或偽衛星的均等物的類SPS信號。
圖2圖示根據一實施的包括示例性IMU 102和示例性SPSU 104的方塊圖200。在一實例中,IMU 102可包括至少一個加速計202和至少一個陀螺儀204。如所圖示的,IMU 102包括三個加速計202(1)、202(2)和202(3)以及三個陀螺儀204(1)、204(2)和204(3)。然而,給定IMU 102可包括更多或更少加速計202及/或陀螺儀204。
如圖所示,每個加速計202(1)、202(2)和202(3)量測並提供各自的加速度206(1)、206(2)和206(3)。類似地,每個陀螺儀204(1)、204(2)和204(3)量測並提供各自的旋轉208(1)、208(2)和208(3)。而且,經由從衛星系統接收的及/或與衛星系統交換的信號,SPSU 104可提供SPS資料。例如,SPSU 104可以能夠提供位置資料210及/或速度資料212。若提供的是位置210(而非速度212),則位置210隨時間的改變可被用來計算從SPS位置資料推導出的或另行基於SPS位置資料的速度212。
一般而言,感測器(例如,加速計202、陀螺儀204等)可被包含在可攜式設備自身內,或者可代替地與此類可攜式設備通訊。例如,此類感測器可被包含在可耦合到可攜式電子設備的模組內以量測運動。此類模組可包括例如可以可拆卸地耦合到可攜式電子設備的另一電子設備。
加速計可被用於感測重力或該加速計所體驗到的任何其他(例如,線性)力的方向。陀螺儀可被用於量測旋轉資訊,包括航向改變。陀螺儀可偵測由於例如在蜿蜒的道路或不平坦的道路上駕駛而導致的旋轉。
若特定實施採用加速計和陀螺儀(「gyros」)兩者,則可提供6個維度的可觀察性(x,y,z,ω,φ,Ψ)。加速計可感測線性運動(例如,在諸如水平面之類的平面中的平移)。可參照至少兩個維度來量測平移。此種加速計亦能提供對物體的傾斜(側滾或俯仰)的量測。由此,有了單個3D加速計,就能感測物體在笛卡爾座標空間(x,y,z)中的運動,並且能感測重力方向以估計該物體的側滾(ω)和俯仰(φ)。由於加速計也許不能容易地區分物件的線性運動與傾斜,因此可以使用陀螺儀來量測繞(x,y,z)座標的旋轉,亦即側滾(ω)及/或俯仰(φ)及/或平搖(Ψ),後者有時被稱作方位角或航向。線性和角加速計、陀螺儀等可被整合到可攜式電子設備中以提供適當的方次的可觀察性。
一些加速計可以提供量值及/或方向,而其他加速計可能簡單地提供運動指示而不帶量值。加速計可量測沿參照一個、兩個或三個線性方向的線的線性運動,該等線性方向往往用笛卡爾座標(x,y,z)來述及。例如,一維加速計可提供指示沿x-維的線性運動的量測。二維加速計可提供指示在沿x-維和y-維兩者的平面中的線性運動的量測,而三維加速計可提供指示在沿x-維、y-維和z-維的三維空間中的線性運動的量測。僅舉例而言,三維加速計可包括二維加速計與一維加速計的組合,或者其可包括三個一維加速計。
測得加速度可以用向量形式來表達(例如,具有量值和方向及/或與量值和方向相關聯),或者其可表達為純量值、一系列純量值、時變函數、其某種組合等。一般而言,加速計可包括用於偵測運動並產生指示沿此種加速計的此一個、兩個或三個維度的線性運動的資訊的感測構件。或者,可以使用非笛卡爾座標系。在特定實施中,座標系可定義相互正交的維度。應注意,可在所描述的實施中替代地採用不同於上述實例的加速計而不脫離所主張的標的。
陀螺儀可量測旋轉並用純量值、一系列純量值、時變函數、向量等來表示此類旋轉運動,此處僅列舉了少數實例。陀螺儀可量測繞一個維度、兩個維度或三個維度的旋轉運動(例如,向量)。在一個特定實施中,陀螺旋轉可以是以座標(ω,φ,Ψ)的形式來量測的,其中tau(ω)表示平搖或即繞z-維的旋轉,phi(φ)表示側滾或即繞x-維的旋轉,而psi(Ψ)表示俯仰或即繞y-維的旋轉。在示例性實施中,陀螺儀可包括一維陀螺儀以提供指示繞第一維的旋轉運動的量測。在另一示例性實施中,陀螺儀可包括二維陀螺儀以提供指示繞第一維和第二維的旋轉運動的量測。類似地,在另一示例性實施中,陀螺儀可包括三維陀螺儀以提供指示繞第一維、第二維和第三維的旋轉運動的量測。
舉例而言,此類三維陀螺儀可包括二維陀螺儀與一維陀螺儀的組合,或者其可包括三個一維陀螺儀。旋轉運動可由三個純量值、一系列純量值、向量形式的時變函數等來表示,此處僅列舉了少數實例。在特定實施中,陀螺儀可包括用於偵測運動並產生指示繞該陀螺儀的一個維度、兩個維度或三個維度的旋轉(例如,角)運動的資訊的感測機制。應注意,可在所描述的實施中替代地採用不同於上述實例的陀螺儀而不脫離所主張的標的。
舉例而言,單個(例如,1-D)加速計可量測加速度,而單個(例如,1-D)陀螺儀可量測諸如傾斜或側滾之類的旋轉運動。另外,將兩個單獨的加速計、兩個單獨的陀螺儀,或者加速計與陀螺儀的組合整合到可攜式電子設備中可以用來既感測加速度又感測角運動。在另一實例中,三維加速計和三維陀螺儀(例如,包括三個1-D加速計和陀螺儀)提供六個維度的可觀察性(x,y,x,ω,φ,Ψ)。可以使用維度約簡的感測器來感測較少維度的加速度及/或旋轉運動。例如,二維加速計和二維陀螺儀可以提供四個維度的可觀察性(x,y,ω,φ)。本文中描述的某些示例性實施可實施一或多個維度的至少一個加速計202以獲得加速度資料206以及實施一或多個維度的至少一個陀螺儀204以獲得旋轉資料208。
特別參看圖3-圖6來描述不同的座標系。如以上論述的,可由IMU量測的方向可被變換到基於地球的座標系以決定IMU相對於基於地球的座標系的空間校準。可採用一或多個中間變換來達成整體變換。在某些示例性實施中,從IMU座標系向基於地球的座標系的轉換是使用一系列(例如,三次)旋轉來完成的。多個座標系中的每一個可從一個座標系變換到另一個。
為了從IMU座標系轉換到基於地球的座標系,例如可使用變換矩陣。因此,可至少近似地決定IMU座標系與ECEF座標系之間的變換矩陣。該旋轉矩陣可被建構成一系列旋轉,如下式(1)中所示:
變數「RCU」表示右、對地航線(course-over-ground)及上方向。變數「ENU」表示東、北及上方向。如本文中所使用的,「基於地球的座標系」可以代表ECEF。「基於主方向的座標系」可以代表利用主方向的座標系,諸如舉例而言ENU系。「基於車輛的座標系」可以代表利用車輛的運動通常所在的方向的座標系,諸如舉例而言RCU系。
因此,對於涉及等式(1)的示例性實施,變換可從IMU前進至RCU,從RCU前進至ENU,以及從ENU前進至ECEF。可方便地選擇RCU座標系以使得RCU中已知的向量能在IMU座標系中量測。此舉促進了其向ECEF系中的變換,因為兩者皆可使用例如來自SPS的資料來存取或獲得。
圖3根據一實施圖形地圖示ECEF座標系與基於主方向的座標系之間的示例性關係300。換言之,圖3可圖示ECEF座標系與ENU座標系之間的示例性關係。關係300被圖示為包括表示地球的球形。地球被圖示為具有三個軸XECEF 、YECEF 和ZECEF 。亦畫出了本初子午線作為參考。該等軸可表示ECEF。
作為實例基於主方向的座標系的ENU亦包括三個軸。例如,該三個軸和方向可以為:東(E)、北(N)和上(U)。應注意,鑒於該ENU系和ECEF系在下文描述的示例性數學實施中是同心的,圖3有些許不精確。換言之,該兩個系之間沒有平移;因此,可在不平移的情況下使用旋轉來完成變換。旋轉可取決於可從例如SPS解獲得的大地量測學座標緯度φ和經度λ,如等式(2)中所示:
圖4根據一實施圖形地圖示基於主方向的座標系與基於車輛的座標系之間的示例性關係400。換言之,圖4可圖示ENU座標系與ECU座標系之間的示例性關係。來自(圖3的)關係300的ENU座標系亦被圖示關係400的一部分。作為實例基於車輛方向的座標系的RCU亦包括三個軸。例如,該三個軸和方向可以為:右(R)402、對地航線(C)404和上(U)406。該三個RCU軸和方向可參照車輛110來定義。
RCU座標系可從ENU系藉由繞上(U)軸406旋轉ENU系以使得北(N)軸指向SPS速度的水平分量的方向(例如,對地航線(C)方向404)來建構。此舉促進了座標系轉換,因為該SPS速度分量近似指向車輛的前向軸的方向。本文中描述的多個示例性實施代表SPS導出資料、SPS有關位置資料,及/或SPS有關速度資料。然而,應理解,此類資料可從作為SPS源的替代或補充的一個或數個不同源獲得。例如,可從不同的導航有關裝置及/或系統推導及/或另行獲得位置資料及/或速度資料。
旋轉可使用從SPS資料推導出的速度來計算,如等式(3)-等式(7)中所示:
其中
使用SPS速度的東分量和北分量
在示例性實施中,在此分析中可考慮其水平SPS速度大於零的彼等點。此舉可以使用以下介紹的最小速度條件來完成。
亦需確定矩陣才能使用以上等式(1)來計算。圖5和圖6圖示了與確定矩陣有關的概念。
圖5根據一實施圖形地圖示因車輛110的典型結構態樣導致的車輛運動的基於車輛的示例性潛在方向502。應注意,車輛很可能運動的方向受車輛的典型結構態樣約束。例如,車輛可具有約束如何推進車輛的多個軸。因此,車輛很少側向運動(例如,滑行)。若行動站與IMU相關聯而該IMU相對於其正身處其中運動的車輛固定,則該等車輛有關運動約束可被有效地傳遞到IMU感測器系。
車輛110可被視為在基於車輛的座標系(諸如所圖示的RCU座標系)中操作。上(U)方向406可繼續與重力方向基本平行地延伸。應理解,該兩個方向(例如,上方向和重力方向)出於數個原因可能不是完全相同。僅舉例而言,在車輛行經地球的上坡、下坡以及越過斜坡部分時,上方向可能不平行於重力方向。儘管如此,上(U)方向406仍可被視為與重力方向基本平行。
對於示例性實施,圖5中圖示兩個基於車輛的方向502。基於車輛的一個示例性方向502可對應於對地航線(C)方向404。基於車輛的另一示例性方向502可對應於右(R)方向402。可將該兩個基於車輛的方向502與其他資料相關以促進對IMU校準的決定。相關(correlation)操作以下特別參看圖6來介紹並在此後進一步解釋。
圖6根據一實施圖形地圖示兩種示例性類型的基於車輛的方向以及可與此類基於車輛的方向相關的兩種示例性類型的可獲得的車輛有關的運動資料。如所圖示的,有三個與IMU座標系有關的方向:右左方向602;前後方向604;及上下方向606。如上所述,上下方向606可對應於(圖4和圖5的)上(U)方向406。
在某些示例性實施中,(圖5的)基於車輛的方向502的示例性對應方向包括但不限於右左方向602和前後方向604。更特定言之,右左方向602可對應於(圖4和圖5的)右(R)方向402,並且前後方向604可對應於(圖4和圖5的)對地航線(C)方向404。藉由將識別出的車輛方向(例如,602、604及/或606)與基於車輛的方向(例如,402、404、406及/或502)相關聯,便可在RCU座標系中有效地實施與IMU量測相關聯的方向。右左方向602、前後方向604及/或上下方向606可使用例如經由IMU獲取的量測來識別。此類量測可以是加速度、旋轉等,此處僅列舉了少數實例。
為了識別此類方向,可確定並分析一或多個相關指示。在示例性實施中,前後方向604可基於從由IMU測得的加速度與從自SPS資料獲得的速度資料推導出的加速度608之間及/或之中的一或多個相關(correlation)操作得到的至少一個相關指示來識別。SPS資料可包括例如(圖2的)位置資料210及/或(例如,直接)速度資料212。在另一示例性實施中,右左方向602可基於從由IMU測得的加速度與旋轉資料610之間及/或之中的一或多個相關操作得到的至少一個相關指示來識別。旋轉資料610可例如從由陀螺儀(例如,其可被包括作為IMU的一部分)測得的旋轉資料208或從經由不同源另行測得或獲得的資料推導出。旋轉資料610可反映繞與上下方向606相對應的軸的一或多個旋轉612(及/或其部分)。
圖7是圖示根據一實施的用於決定IMU的空間校準的示例性機制700的方塊圖。如所圖示的,機制700包括車輛有關運動資料702、一或多個相關(correlation)單元704、至少一個關聯單元706、第一方向708、至少一個決定單元710,以及空間校準712。機制700亦包括第一加速度206-1和第二加速度206-2。
對於某些示例性實施,相關單元704用於執行涉及車輛有關運動資料702且涉及第一加速度206-1或第二加速度206-2中的至少一者的一或多個相關操作。第一加速度206-1和第二加速度206-2可對應於如由IMU測得的(圖2的)加速度206(1)、206(2)及/或206(3)中的一或多個。換言之,在示例性實施中,第一加速度206-1及/或第二加速度206-2可等同於、推導自(等)由(圖1、圖2和圖12的)IMU 102的(圖2的)一或多個加速計202測得的加速度206中的一者或其組合。第一加速度206-1和第二加速度206-2各自可包括或關聯於該加速度的方向(如為機制700用虛線圖示的)。車輛有關運動資料702的實例可包括,但不限於,SPS導出加速度608、旋轉資料610等等。相關操作可得到至少一個相關指示。
基於車輛的方向502可基於該一或多個相關操作(例如,基於該至少一個相關指示)來識別。如上所述,基於車輛的方向502的實例可包括,但不限於,前後方向604和右左方向602。關聯單元706可將識別出的基於車輛的方向502與第一方向708相關聯。換言之,基於該一或多個相關操作,可將第一方向708與關聯於第一加速度206-1或第二加速度206-2的該等方向中的至少一個方向相關聯。
第一方向708可對應於基於車輛的座標系(例如,RCU)中的方向中之一者。因此,可基於該一或多個相關操作將關聯於第一加速度206-1或第二加速度206-2的方向中之一者與例如右(R)方向402或對地航線(C)方向404相關聯。決定單元710可至少部分地基於第一方向708來決定(圖1、圖2和圖12的)IMU 102的空間校準712。該決定可使得必須進行一或多個變換。例如等式(1)的旋轉矩陣可被用於決定空間校準712。
下文特別參看圖9-圖11的機制900來描述某些示例性態樣的更詳細說明。機制900描述了如何可使用第一和第二加速度206-1或206-2中的一者來識別一個基於車輛的方向502,以及如何可使用第一和第二加速度206-1或206-2中的另一者來識別另一個基於車輛的方向502。以該示例性方式,右左方向602和前後方向604可被識別。機制900亦描述了如何可使用第三加速度206-3來識別可與重力方向基本平行的上下方向。應注意,基於車輛的座標系(例如,RCU)的多個方向可基本正交。若三個方向正交,則可從第一方向和第二方向發現第三方向。因此,若已識別出上下方向606,則右左方向602或前後方向604中的一者可從另一者來發現。
圖8是圖示根據一實施的用於決定IMU的空間校準的示例性方法的流程圖800。如所圖示的,流程圖800包括6個操作方塊802、804、804a、804b、806和808。儘管操作802-操作808(包括804a和804b)是以特定次序來圖示和描述的,但是應理解,可以替代方式執行各方法而不脫離所主張的標的。
對於某些示例性實施,在操作802處,可使用IMU量測一或多個加速度。在操作804處,可基於涉及車輛有關運動資料且涉及第一加速度或第二加速度中的至少一者的一或多個相關操作來識別第一基於車輛的方向。
在操作806處,可將該第一基於車輛的方向與可變換到基於地球的座標系的第一方向相關聯。在操作808處,可基於該第一方向來決定IMU相對於基於地球的座標系的空間校準。
該空間校準可由決定其的設備及/或由另一設備利用。該空間校準例如可使用有線鏈路(例如,直接連接、敷設電纜等)或無線鏈路(例如,紅外線、Wi-Fi、藍芽、蜂巢技術等)被傳達給另一設備。所決定的IMU空間校準可例如應用於由SPS-INS或其他導航技術執行的導航。
識別第一基於車輛的方向的操作(804)可使用操作804a及/或操作804b來實施。在操作804a處,可執行涉及SPS導出加速度且涉及第一加速度或第二加速度中的至少一者的一或多個相關操作以識別前後方向。在操作804b處,可執行涉及旋轉資料且涉及第一加速度或第二加速度中的至少一者的一或多個相關操作以識別右左方向。
圖9、圖10和圖11是圖示根據一實施的用於決定IMU的空間校準的另一示例性機制900的方塊圖。機制900分佈在圖9、圖10和圖11上。機制900可使用例如三個加速度來實施:第一加速度206-1、第二加速度206-2和第三加速度206-3。
如所圖示的,圖9中的機制900A包括加速度比較單元902和(重力)方向識別單元904。對於某些示例性實施,加速度206可被提供給加速度比較單元902。尤其是若原始的測得加速度206被提供給加速度比較單元902,則加速度比較單元902可處理加速度206。例如,可以一或多種方式過濾時間上的多個加速度。例如,可在時間上對加速度取平均。無論如何,加速度比較單元902可比較該多個加速度以確定哪個加速度最強。最強加速度可被輸出作為第三加速度206-3。
方向識別單元904獲得第三加速度206-3並確定隨其所包括或至少與之相關聯的方向。(最強)第三加速度206-3的方向被識別為上下方向606。由於重力產生最強加速度,因此上下方向606與重力方向至少基本平行。上下方向606在圖11中應用。
非最強的(諸)加速度可由加速度比較單元902輸出作為第一加速度206-1及/或第二加速度206-2。第一和第二加速度206-1和206-2在圖10中應用。機制900亦應用車輛有關運動資料702。舉例而言,車輛有關運動資料702可包括SPS導出加速度608、旋轉資料610等等。車輛有關運動資料702在圖10中應用。
如所圖示的,圖10中的機制900B包括相關(correlation)單元704a、相關單元704b,以及基於車輛的方向識別單元1002。第一加速度206-1、第二加速度206-2、SPS導出加速度608和旋轉資料610是從圖9提供的。對於某些示例性實施,第一加速度206-1及/或第二加速度206-2可被提供給相關單元704a和相關單元704b。相關單元704a可執行SPS導出加速度608與第一加速度206-1及/或第二加速度206-2之間及/或之中的一或多個相關操作。(諸)相關操作可產生至少一個相關指示。基於涉及SPS導出加速度608的該至少一個相關指示,可由基於車輛的方向識別單元1002識別前後方向604。例如,可在與第一加速度206-1相關聯的方向和與第二加速度206-2相關聯的方向之間選擇作為前後方向604的方向。例如,與第一加速度206-1或第二加速度206-2相關聯的、與SPS導出加速度608具有較高相關的方向可被識別為前後方向604。
相關單元704b可在旋轉資料610和第一加速度206-1及/或第二加速度206-2之間及/或之中執行一或多個相關操作。(諸)相關操作可產生至少一個相關指示。基於涉及旋轉資料610的該至少一個相關指示,可由基於車輛的方向識別單元1002識別右左方向602。例如,可在與第一加速度206-1相關聯的方向和與第二加速度206-2相關聯的方向之間選擇作為右左方向602的方向。例如,與第一加速度206-1或第二加速度206-2相關聯的、與旋轉資料610具有較高相關的方向可被識別為右左方向602。
對右左方向602及/或前後方向604的識別可涉及由基於車輛的方向識別單元1002作出的附加分析。例如,可將該至少一個相關指示與在識別方向前要滿足(例如,等於或超過)的預定閾值作比較。而且,可實施在識別方向之前確保兩個相關指示之間存在預定閾值跨距或差距(例如,確保一個相關指示充分大於另一個)的閾值操作。此外,可核實不同相關操作提供一致結果。可替代地實施在識別方向前對相關指示的其他分析而不脫離所主張的標的。下文結合示例性數學說明來描述更詳細的分析實例。而且,如上所述,在識別了上下方向606之後,對右左方向602或前後方向604中的一者的識別使得另一者能使用正交性原理(例如,右手定則)來識別。
如所圖示的,(圖9的)機制900A識別上下方向606,並且(圖9B的)機制900B識別右左方向602和前後方向604。該等識別出的方向可被視為對應於IMU座標系。因此,可將該三個識別出的方向與基於車輛的座標系(例如,RCU座標系)中的方向相關聯以將其與可變換到基於地球的座標系的方向相關聯。圖11中圖示示例性關聯,其中應用來自機制900B的右左方向602和前後方向604。
如所圖示的,圖11中的機制900C包括關聯單元706a、關聯單元706b和關聯單元706c。上下方向606是從圖9提供的。右左方向602和前後方向604是從圖10提供的。對於某些示例性實施一般而言,關聯單元706可將各自的基於車輛的方向與各自的可變換到基於地球的座標系的方向相關聯。更特定言之,關聯單元706a可將右左方向602與右(R)方向402相關聯。關聯單元706b可將前後方向604與對地航線(C)方向404相關聯。關聯單元706c可將上下方向606與上(U)方向406相關聯。
右(R)方向402、對地航線(C)方向404,以及上(U)方向406是基於車輛的座標系中的可變換到基於地球的座標系中的方向。其例如可使用一或多個旋轉矩陣來變換。舉例而言(但並非限制),基於車輛的座標系中的方向可被變換成基於主方向的座標系中的方向。基於主方向的座標系中的方向可被變換到基於地球的座標系中。
下文從相對數學的觀點進一步描述多個示例性實施。在數學地描述的第一示例性實施中,分析由IMU測得的加速度並計算其特徵向量。特徵向量的方向被用於識別基於車輛的方向。在以下數學地描述的第二示例性實施中,實施二維特徵向量辦法。在以下數學地描述的第三示例性實施中,實施省去特徵向量確定的二維相關辦法。後兩種示例性實施將加速度投影到與重力方向至少基本正交的平面上。如上文描述的,可能不能精確地獲得重力方向(例如,由於車輛可能正行經的斜坡)。可替代地實施其他辦法而不脫離所主張的標的。
在數學地描述的第一示例性實施中,可實施六個示例性操作。第一,可藉由對測得加速度取平均來決定重力方向。第二,可藉由發現加速度特徵向量來發現作為整體群組的上下方向、前後方向和橫向方向。第三,可經由將上下特徵向量與重力方向匹配並建構對應的單位向量來識別向上方向。第四,可藉由將Z陀螺儀資料(例如,上陀螺儀資料)與沿右左軸的加速計量測相關來沿右左軸識別「右」方向。亦可建構對應的單位向量。
第五,可藉由將沿前後軸的IMU加速度與沿SPS速度方向的SPS導出加速度相關來識別前向方向。亦可建構對應的單位向量。第六,可使用該等單位向量來建構車輛與ECEF座標系之間的旋轉矩陣。應注意,可實施六個操作中不滿全部的操作而不脫離所主張的標的。而且,該等操作可按不同次序實施而不脫離所主張的標的。
對於第一操作,重力方向可被用於(部分地)校準IMU,因為與重力相對應的加速度在RCU系中指向上,因此在正規化之後,其表示RCU系中的向上軸。儘管由加速計獲得的重力量測受車輛的伴隨加速度擾動,但車輛加速度很可能隨時間推移被平均掉。即使該假定不是完全正確的,可能導致的水平校準誤差對於成功初始化IMU而言亦是可接受的。根據將IMU資料從IMU系旋轉各個量到失準系中的失準研究,為了在與SPS資料的組合導航開始之後成功校準IMU,能容忍多達例如10度的初始IMU定向誤差。
根據以上假定,在IMU感測器系中測得的平均加速度向量d 指向上,與重力相對,如等式(8)中所示:
其中n 為合適地選擇的取樣大小。為了使轉彎效應最小化,可根據等式(9)考慮陀螺儀讀數低於經驗閾值的彼等資料點:
在實際實施中,等式(8)中的除以n 可被省略,因為d 的長度在後續計算中不是特別重要。
若車輛處於運動中或者若車輛恰好在該等量測期間駐定,則實現第一操作的該示例性辦法起效。事實上,若車輛駐定,該辦法可能效果更好,因為以此方式在駐定期期間獲得d 向量在實效上類似於決定側滾和俯仰角──其是用於初始駐定校準的一般方法。
對於第二操作,可確定車輛軸方向。觀察到在路面車輛中,由於此類車輛的機械構造,測得加速度的水平分量大多數在平均意義上指向橫向和前向車輛體軸的方向。車輛速度變化顯現在前後方向上。由於轉彎造成的向心加速度和由於側滾造成的重力分量顯現在右左(例如,橫向)方向上。可使用例如特徵向量方法來確定加速度的該等強勢空間方向。
首先,可針對每個曆元i 計算測得加速度向量的外積:
隨後對合適的取樣大小n 取平均,例如n =60:
在實際實施中,除以n 可被省略,因為矩陣元素的絕對量值在後續計算中不是特別重要。取而代之,可使用其相對量值。
為了使因低速導致的方向不定性最小化,可使用等式(12)和等式(13)來考慮SPS速度高於經驗地決定的閾值的彼等資料點:
在求解下式(14):
Ae k k e k ,k=0,1,2, (14)
之後,可考慮特徵向量e 0 ,e 1 ,e 2 及其對應的特徵值λ012 。該等特徵向量被排序和命名以使得|λ0 |1 |2 |。在本文中,其有時亦可分別被稱為第一加速度、第二加速度和第三加速度。
對於第三操作,可識別上下單位向量(例如,其是上下方向606的實例)。與最大特徵值相對應(而不考慮其符號)的特徵向量提供重力方向。在已知d 指向上的情況下使用等式(15)和等式(16)來調整e 2 的符號:
e 2d >0,則u =e 2  (15)
e 2d <0,則u =-e 2  (16)
其中u 是上下指向的單位向量。
對於第四操作,可識別指向右的單位向量(例如,其是右左方向602的實例)。觀察到垂直陀螺儀分量可與橫向加速度高度相關。其可被用於選擇車輛的橫向體軸。如第二操作中所見,e 0e 1 中之一者位於橫向方向上。準備與該兩個水平單位向量e 0e 1 相對應的兩個候選。可執行一或多個相關操作以在該兩個候選之間進行識別和選擇。例如,可選擇提供較好相關的彼候選。
可如下在等式(17)-等式(21)中一般來確定垂直陀螺儀分量和該兩個潛在IMU加速度:
ω u , i =uω i  (17)
a IMU , f ,0, i =e 0a i  (18)
a IMU , f ,1, i =e 1a i  (19)
其條件為:
隨後可使用下式(22)-(28)來確定兩個示例性相關指示:
c 0,0 =Corr (a IMU , f ,0, i ,-ω u , i ) i =0,..., n -1  (22)
c 0,1 =Corr (a IMU , f ,1, i ,-ω u , i ) i =0,..., n -1  (23)
在此
其中
等式(22)和等式(23)中ω u , i 前的負號表達了陀螺儀速率與指向右的加速度異相180°的事實。具有較大量值的彼相關係數(例如,其是相關指示的實例)可被用於選擇e 0e 1 向量作為右左方向,且其符號可決定方向。可對該等相關係數執行以下分析以識別方向,如等式(29)-等式(32)中所示:
若|c 0,0 |<0.5且|c 0,1 |<0.5,則為非決定性的 (29)
否則
若||c 0,0 |-|c 0,1 ||<0.2,則為非決定性的 (30)
否則
若|c 0,0 |<|c 0,1 |,則e r =e 1c r =c 0,1  (31)
否則e r =e 0c r =c 0,0  (32)
等式(29)確保了對所選方向的相關指示足夠強。可替代地使用除0.5以外的值(大於或者小於0.5)。等式(30)確保了該兩個相關指示之間的差分足夠大。可替代地使用除0.2以外的值(大於或者小於0.2)。應注意,可替代地實施對相關操作及/或結果所得的相關指示的其他分析。
可如等式(33)中所示地決定關於r 0 的向量:
r 0 =sign (c r )‧e r 。 (33)
如上所述,可基於該三個方向之間的至少基本的正交性來獲得第三(例如,在該情形中為指向前向的)單位向量。例如,可由ur 0 的叉積獲得指向前向的單位向量:
f 0 =u ×r 0 。 (34)
對於第五操作,可識別前向單位向量(例如,前後方向604的實例)。由於車輛的機械構造,除了在轉彎時外,水平速度通常指向車輛的前向方向。因此,其時間導數即前向加速度與在IMU系中測得的前向加速度高度相關。如上文的第二操作中所示,e 0e 1 中之一者位於前後方向上。為了確定是哪一個,可執行一或多個相關操作。例如,可計算從如自基於SPS的速度計算出的前向加速度與分別在e 0e 1 方向上的前向加速度之間的相關推導出的至少一個相關指示。較高的彼相關量值可被用於識別和選擇前向軸。
可從等式(35)和等式(36)計算SPS加速度:
其中Δt 是曆元i 和曆元i -1之間的時差。
另一方面,可經由將測得加速度向量分別投影到水平特徵向量來確定前向IMU加速度候選,如等式(37)和等式(38)中所示:
a IMU,f, 0 ,i =e 0a i  (37)
a IMU,f, 1 ,i =e 1a i , (38)
其中可選擇第i 量測(i =0,...,n -1)以使得陀螺儀讀數小於所選閾值,從而使轉彎的效應最小化,並且SPS速度足夠大以提供更好的加速度準確性。該等示例性約束可用等式(39)來實施:
可將SPS速度與每個曆元i 匹配。陀螺儀閾值可經驗地決定。例如,可如等式(40)中所示地決定陀螺儀閾值:
ω閾值 =5° /s 。 (40)
可藉由確定至少一個相關指示來進一步執行一或多個相關操作。例如,可如等式(41)和等式(42)中所示地計算相關係數(例如,其是相關指示的實例):
c 1,0 =Corr (a IMU , f ,0, i ,a SPS , f , i ) i =0,..., n -1  (41)
c 1,1 =Corr (a IMU , f ,1, i ,a SPS , f , i ) i =0,..., n -1 。 (42)
較高的彼c k 係數可用於選擇e 0e 1 向量,且其符號可決定方向。可作為對該一或多個相關操作的相關分析的部分應用相關閾值。示例性分析在下文在等式(43)到等式(47)中提供並在上文關於第四操作進行了解釋。
若|c 1,0 |<0.5且|c 1,1 |<0.5,則為非決定性的 (43)
否則
若||c 1,0 |-|c 1,1 ||<0.2,則為非決定性的 (44)
否則
若|c 1,0 |<|c 1,1 |,則e f =e 1c f =c 1,1  (45)
否則e f =e 0c f =c 1,0  (46)
從該取閾分析,可如等式(47)中所示地識別前向單位向量:
f 1 =sign (c f )‧e f 。 (47)
若要不用一或多個直接相關操作地來獲得第三(例如,指向右的)單位向量,則由於其與上方向的正交性,因此可採用右手定則。因而,可由uf 1 的叉積獲得指向右的單位向量,如等式(48)中所示:
r 1 =f 1 ×u 。 (48)
對於第六操作,可決定IMU系與ECEF系之間的旋轉矩陣。第四操作和第五操作可提供一致結果。換言之,來自等式(49)和等式(50)的以下命題通常保持為真:
r 1 =r 0  (49)
f 1 =f 0 。 (50)
因此,可在等式(51)和等式(52)中定義下式:
r =r 1 =r 0  (51)
f =f 1 =f 0 。 (52)
等式(49)和等式(50)中的等式由於數值不準確性故而可能不能在數值上求值,但其可被用來驗證e r e f 選擇了不同的e k 向量(例如,k=0或1)。
若第四操作和第五操作兩者皆提供結果,但該等結果不一致(例如,若e r e f 兩者選擇了相同的e k (k=0或1)),則可對新的一組n 個量測重複該校準決定。若第四操作和第五操作中之一者失敗或提供非決定性的結果(例如,相關係數的值太接近或者兩者皆太低),則可使用由其他操作推導出的軸。例如,若第四操作失敗,則:
r =r 1  (53)
f =f 1 。 (54)
若第四操作和第五操作兩者皆失敗,則可對新的一組n 個量測重複該校準決定。
一旦指向右的單位向量r 和指向前向的單位向量f 可用,就可使用指向上的單位向量u (如第三操作中識別出的)藉由將該等單位向量與諸如RCU之類的基於車輛的座標系的基本向量相關聯來完備該座標系。因此,由於rfu 是RCU系的3個基本向量如表達在IMU系中時的形式,故而可如等式(55)中所示地建構旋轉矩陣
最後,可使用下式(56)以一或多次旋轉來完成從IMU系向ECEF系的變換:
對於數學地描述的第二示例性實施,採用二維特徵向量辦法。更特定言之,決定r 單位向量和f 單位向量的該辦法可涉及二維特徵向量解。可以不是使用全三維的加速度來確定特徵向量三位元組e 0 ,e 1 ,e 2 ,而是代之以在將該等加速度投影到水平面上之後確定水平特徵向量對e 0 ,e 1 。水平面可使用垂直d 向量藉由確定與其至少基本正交的平面來決定。
該辦法可包括以下操作。第一,可藉由對測得加速度取平均來獲得重力方向。第二,可確定水平面為與垂直方向基本正交的一個平面。第三,可藉由從投影到水平面上的加速度發現特徵向量來識別群組形式的前後方向和右左方向。其餘操作可與以上針對三維特徵向量辦法描述的彼等操作相同,以個體地來識別前後方向和右左(橫向)方向。
對於數學地描述的第三示例性實施,採用無需涉及特徵向量的二維相關辦法。更特定言之,該辦法可使得必須從投影到水平面上的加速度直接識別前後方向和右左方向,而不涉及特徵向量。該「二維相關」可用於確定水平面中所投影加速度與計算出的SPS加速度之間的相關最高的方向;此舉可用於識別前後方向。類似地,與垂直陀螺儀分量的相關可識別右左(橫向)方向。在該二維相關辦法的示例性變型中,該兩個相關操作可被組合以在前向方向和橫向方向在水平面中正交此約束下一次性提供前向和橫向該兩個方向。
圖12是圖示根據一實施的可實施用於決定IMU的空間校準的一或多個態樣的示例性設備1200的示意圖。如所圖示的,設備1200包括至少一個處理器1202、一或多個記憶體1204、至少一個通訊介面1206、其他感測器1208以及至少一個電源1210。記憶體1204被圖示為包括指令1212。設備1200亦被示為包括IMU 102和SPSU 104。IMU 102被示為包括一或多個加速計202以及一或多個陀螺儀204。然而,設備1200可替代地包括與所圖示的元件相比更多、更少,及/或不同的元件。
對於某些示例性實施,設備1200可包括及/或包含電子設備。設備1200的實例可包括,但不限於:(圖1的)行動站106、可攜式電子設備、電腦、行動網際網路設備(MID)、娛樂設備、任何具有至少一個處理器及/或記憶體的電子設備、其某種組合等等。電源1210可向設備1200的元件及/或電路系統供電。電源1210可以是可攜式電源,諸如電池,或者是固定電源,諸如汽車、房屋或其他建築物中的插座。電源1210可以與設備1210整合或分離。
處理器1202可包括任何一或多個處理單元。記憶體1204可包含測得加速度、旋轉等等。其亦可儲存本文描述的正被操縱的變數、參數等的實體版本。記憶體1204亦可用於儲存可由處理器1202執行的指令1212(例如,程式、應用等或其部分;處理器可執行指令;代碼;其某種組合;等等)。一或多個處理器1202對此類指令1212的執行可將設備1200變換成專用計算設備、裝置、平臺、其某種組合等等。
通訊介面1206可提供設備1200與操作人員及/或其他設備之間的介面。因此,通訊介面1206可包括螢幕、揚聲器、按鍵,或其他人類輸入/輸出設備。通訊介面1206可包括收發機、無線電、天線、有線介面裝置、其某種組合等以傳達無線及/或有線信號。通訊介面1206亦可充當設備1200的其他元件之間及/或之中的匯流排或其他互連。(諸)其他感測器1208(若存在)可包括一或多個能量測其他參數的其他雜項感測器。(諸)其他感測器1208可包括磁力計、羅盤等,此處僅列舉了少數實例。
本文中描述的方法取決於根據特定特徵及/或實例的應用可以藉由各種手段來實施。例如,此類方法可在硬體、韌體、軟體、個別/固定邏輯電路系統、其任何組合等等中實施。在硬體及/或邏輯電路系統實施中,例如,處理單元可在一或多個特殊應用積體電路(ASICs)、數位信號處理器(DSPs)、數位信號處理設備(DSPDs)、可程式邏輯設備(PLDs)、現場可程式閘陣列(FPGAs)、處理器、控制器、微控制器、微處理器、電子設備、設計成執行本文中所描述的功能的其他設備或單元及/或其組合內實施,此處僅列舉了幾個實例。
對於韌體及/或軟體實施,該等方法可用具有執行本文中描述的功能的指令的模組(例如,程序、函數等等)來實施。有形地實施指令的任何機器可讀取媒體可用於實施本文中所描述的方法。例如,軟體代碼可被儲存在記憶體中並由處理器執行。記憶體可以實施在處理器內部或處理器外部。如本文所使用的,術語「記憶體」代表任何類型的長期、短期、揮發性、非揮發性,或其他記憶體,且並不限於任何特定類型的記憶體或特定數目的記憶體,或記憶體儲存在其上的媒體的類型。
在一或多個示例性實施中,所描述的功能可在硬體、軟體、韌體、個別/固定邏輯電路系統、其某種組合等等中實施。若在軟體中實施,則各功能可以作為一或多個指令或代碼儲存在實體電腦可讀取媒體上。電腦可讀取媒體包括實體電腦儲存媒體。儲存媒體可以是能被電腦存取的任何可用實體媒體。舉例而言(但並非限制),此類電腦可讀取媒體可包括RAM、ROM、EEPROM、CD-ROM或其他光碟儲存器、磁碟儲存器或其他磁性儲存設備,或可被用來儲存指令或資料結構形式的所要程式碼且可被電腦及/或其處理器存取的任何其他媒體。如本文中所使用的磁碟(disk)和光碟(disc)包括壓縮光碟(CD)、雷射光碟、光碟、數位多功能光碟(DVD)、軟碟和藍光光碟,其中磁碟(disk)通常以磁性的方式再現資料,而光碟(disc)用雷射以光學方式再現資料。
而且,電腦指令/代碼可經由實體傳輸媒體上的信號從發射機向接收機傳送。例如,軟體可以是使用同軸電纜、光纖電纜、雙絞線、數位用戶線(DSL),或諸如紅外線、無線電以及微波之類的無線技術的實體元件從網站、伺服器,或其他遠端源傳送而來的。上述的組合亦應被包括在實體傳輸媒體的範圍內。
本【實施方式】的一些部分是以對儲存在特定裝置或專用計算設備或平臺的記憶體內的二元數位信號的操作的演算法或符號表示的形式來提供的。在本特定說明書的上下文中,術語「特定裝置」或類似術語包括通用電腦──只要其被程式編寫為依照來自程式軟體的指令執行特定功能。演算法描述或符號表示是信號處理或相關領域的一般技藝人士用來向本領域其他技藝人士傳達其工作的實質性內容的技術的實例。演算法在此並且一般被認為是得到所要結果的自相容操作序列或類似信號處理。在本上下文中,操作或處理涉及對實體量的實體操縱。通常,儘管並非必然,此種量可採取能被儲存、轉移、組合、比較或以其他方式操縱的電信號及/或磁信號的形式。
業已證明,有的時候,主要為通用之故,將此類信號稱為位元、資料、值、元素、符號、字元、變數、項、數、數值或類似術語是方便的。然而應理解,所有該等或類似術語應與合適實體量相關聯且僅僅是便利性標籤。除非另外特別聲明,否則如從以上論述所顯而易見的,應當瞭解,本說明書通篇中使用諸如「處理」、「計算」、「演算」、「決定」、「確定」、「識別」、「關聯」、「量測」,「執行」或諸如此類的術語的論述代表諸如專用電腦或者類似的專用電子計算設備之類的特定裝置的動作或過程。因此,在本說明書的上下文中,專用電腦或類似專用電子計算設備能夠操縱或變換信號,該等信號通常情況下被表示為該專用電腦或類似專用電子計算設備的記憶體、暫存器,或其他資訊儲存設備、傳輸設備,或顯示設備內的實體電子量、電氣量及/或磁量。
儘管已圖示和描述了目前認為是示例性特徵的內容,但是本領域技藝人士將理解,可作出其他各種改動並且可換用等效技術方案而不會脫離所主張的標的。此外,可作出許多改動以使特定情況適應於所主張的標的的教示而不會脫離本文中所描述的中心概念。因此,所主張的標的並非意欲被限定於所揭示的特定實例,相反,如此主張的標的亦可包括所有落入所附請求項及其等效技術方案的範圍內的態樣。
100...示例性環境
102...慣性量測單元(IMU)
104...衛星定位系統(SPS)單元(SPSU)
106...行動站
108...底座
110...車輛
112...衛星
114...導航圖符
200...方塊圖
202...加速計
202(1)...加速計
202(2)...加速計
202(3)...加速計
204...陀螺儀
204(1)...陀螺儀
204(2)...陀螺儀
204(3)...陀螺儀
206(1)...加速度
206(2)...加速度
206(3)...加速度
206-1...第一加速度
206-2...第二加速度
206-3...第三加速度
208(1)...旋轉
208(2)...旋轉
208(3)...旋轉
210...位置資料
212...速度資料
300...關係
400...關係
402...右(R)方向
404...對地航線(C)方向
406...上(U)方向
502...基於車輛的方向
602...右左方向
604...前後方向
606...上下方向
608...SPS導出加速度
610...旋轉資料
612...旋轉
700...機制
702...車輛有關運動資料
704...相關單元
704a...相關(correlation)單元
704b...相關單元
706...關聯單元
706a...關聯單元
706b...關聯單元
706c...關聯單元
708...第一方向
710...決定單元
712...空間校準
800...流程圖
802...操作方塊/操作
804...操作方塊/操作
804a...操作方塊/操作
804b...操作方塊/操作
806...操作方塊/操作
808...操作方塊/操作
900...機制
900A...機制
900B...機制
900C...機制
902...加速度比較單元
904...(重力)方向識別單元
1002...基於車輛的方向識別單元
1200...設備
1202...處理器
1204...記憶體
1206...通訊介面
1208...感測器
1210...電源
1212...指令
將參看以下附圖來描述非限定性和非窮盡性特徵,其中相同元件符號貫穿各附圖代表相同部分。
圖1是根據一實施的其中可用慣性量測單元(IMU)和SPS單元(SPSU)來實施SPS-INS導航系統的示例性環境的方塊圖。
圖2圖示根據一實施的包括示例性IMU和示例性SPSU的方塊圖。
圖3根據一實施圖形地圖示ECEF座標系與基於主方向的座標系之間的示例性關係。
圖4根據一實施圖形地圖示基於主方向的座標系與基於車輛的座標系之間的示例性關係。
圖5根據一實施圖形地圖示因車輛的典型結構態樣導致的車輛運動的基於車輛的示例性潛在方向。
圖6根據一實施圖形地圖示兩種示例性類型的基於車輛的方向以及可與此類基於車輛的方向相關(correlate)的兩種示例性類型的可獲得的車輛有關的運動資料。
圖7是圖示根據一實施的用於決定IMU的空間校準的示例性機制的示意方塊圖。
圖8是圖示根據一實施的用於決定IMU的空間校準的示例性方法的流程圖。
圖9、圖10和圖11是聯合地圖示根據一實施的用於決定IMU的空間校準的另一示例性機制的方塊圖。
圖12是圖示根據一實施的可實施用於決定IMU的空間校準的一或多個態樣的示例性設備的示意圖。
300...關係

Claims (60)

  1. 一種用於決定一慣性量測單元(IMU)之空間校準的方法,該IMU經定位於一車輛中或一車輛上,該方法包含下列步驟:取得該車輛之車輛相關移動資料,該車輛相關移動資料包括速度資料,該速度資料係藉由一或更多衛星定位系統(SPS)所量測或從該一或更多SPS所獲得之量測結果推導出,該速度資料包括一基於SPS之加速度;取得至少一第一IMU推導出加速度及一第二IMU推導出加速度,該等IMU推導出加速度之各者係藉由該IMU所量測或從該IMU所獲得之量測結果推導出,且該等IMU推導出加速度之各者對應於該車輛的一個別加速度,該IMU係位在該車輛上或該車輛中;在該車輛相關移動資料及該等IMU推導出加速度之一或更多者上進行一或更多運算,以決定在該基於SPS之加速度與該等IMU推導出加速度之該一或更多者之間的一個別相關聯性;將該第一IMU推導出加速度或該第二IMU推導出加速度中與該基於SPS之加速度有一較高相關聯性者的一方向識別為一第一車輛方向;根據該第一車輛方向來決定在一基於地球之座標系統中的一第一基於地球之方向;及 根據該第一基於地球之方向來決定該IMU相對於該基於地球之座標系統的一空間校準。
  2. 如請求項第1項所述之方法,其中該等IMU推導出加速度進一步包括一第三IMU推導出加速度,以及其中該第一IMU推導出加速度、該第二IMU推導出加速度及該第三IMU推導出加速度為實質上正交。
  3. 如請求項第2項所述之方法,進一步包含下列步驟:將該等三個IMU推導出加速度中最弱兩者識別為該第一IMU推導出加速度及該第二IMU推導出加速度。
  4. 如請求項第3項所述之方法,進一步包含下列步驟:將該等三個IMU推導出加速度中最強之一者識別為重力所致之加速度。
  5. 如請求項第1~4項中之任一項所述之方法,其中該車輛相關移動資料進一步包括旋轉資料,該旋轉資料係從一或更多陀螺儀所獲得或推導出,該一或更多陀螺儀之各者經安排以量測該IMU的一個別旋轉。
  6. 如請求項第5項所述之方法,進一步包含下列步驟:在該旋轉資料及該第一IMU推導出加速度及該第二IMU推導出加速度之一或兩者之間進行一或更多第二相關 聯運算。
  7. 如請求項第6項所述之方法,進一步包含下列步驟:將該第一IMU推導出加速度及該第二IMU推導出加速度中與該旋轉資料有最大相關聯性之一者的方向識別為一第二車輛方向,其中決定該第一基於地球之方向之步驟也至少部分基於該第二車輛方向。
  8. 如請求項第7項所述之方法,其中該第一車輛方向對應於該車輛在一基於IMU之座標系統中的一前後移動方向。
  9. 如請求項第8項所述之方法,其中該第二車輛方向對應於該車輛在該基於IMU之座標系統中的一右左移動方向。
  10. 如請求項第7項所述之方法,其中決定在該基於地球之座標系統中的該第一基於地球之方向的步驟包括下列步驟:至少部分地根據該第一車輛方向及該第二車輛方向之一或兩者來決定一第一基於車輛之方向;及根據該第一基於車輛之方向來決定在該基於地球之座標系統中的該第一基於地球之方向。
  11. 如請求項第10項所述之方法,其中該第一基於車輛之方向對應於該車輛在一第一基於RCU(右、對地航線、上) 之座標系統中的一對地航線移動方向。
  12. 如請求項第11項所述之方法,進一步包含下列步驟:根據該第一車輛方向及該第二車輛方向中之至少一者來決定一第二基於車輛之方向,該第二基於車輛之方向對應於該車輛在該第一基於RCU之座標系統中的一右移動方向。
  13. 如請求項第12項所述之方法,進一步包含下列步驟:將該第二基於車輛之方向轉換成在該基於地球之座標系統中的一第二基於地球之方向,其中決定該IMU相對於該基於地球之座標系統的該空間校準的步驟也根據該第二基於地球之方向。
  14. 如請求項第1~4項中之任一項所述之方法,其中該速度資料對應於該車輛在一第一基於SPS之座標系統中的移動。
  15. 如請求項第1~4項中之任一項所述之方法,其中該基於SPS之加速度及該等IMU推導出加速度為線性加速度。
  16. 如請求項第1~4項中之任一項所述之方法,其中該車輛相關移動資料進一步包括從一或更多SPS所獲得之大地測量資料(geodetic data),該大地測量資料對應於該車輛 在一第一大地測量座標系統中的一位置。
  17. 如請求項第16項所述之方法,進一步包含下列步驟:根據該大地測量資料來決定一第一轉換矩陣,該第一轉換矩陣可用以在一基於RCU之座標系統及一基於地球之座標系統之間轉換。
  18. 如請求項第17項所述之方法,進一步包含下列步驟:根據該車輛相關移動資料來決定一第二轉換矩陣,該第二轉換矩陣可用以在一基於IMU之座標系統及一基於RCU之座標系統之間轉換。
  19. 如請求項第1~4項中之任一項所述之方法,其中在由該IMU進行量測期間該IMU為直接或間接可拆卸地固定至該車輛,使得在由該IMU進行量測期間該IMU相對於該車輛的一位置及一校準為恆定。
  20. 如請求項第1~4項中之任一項所述之方法,其中該第一IMU推導出加速度及該第二IMU推導出加速度中之一或兩者係利用一特徵向量所推導出。
  21. 一種電腦可讀取儲存媒體,該電腦可讀取儲存媒體具有指令儲存於其上,該等指令可由一或更多處理器執行以供決定一慣性量測單元(IMU)的一空間校準,該IMU經 定位於一車輛中或一車輛上,當該等指令由該一或更多處理器執行時係可操作以致使該一或更多處理器進行下列步驟:取得該車輛之車輛相關移動資料,該車輛相關移動資料包括速度資料,該速度資料係藉由一或更多衛星定位系統(SPS)所量測或從該一或更多SPS所獲得之量測結果推導出,該速度資料包括一基於SPS之加速度;取得至少一第一IMU推導出加速度及一第二IMU推導出加速度,該等IMU推導出加速度之各者係藉由該IMU所量測或從該IMU所獲得之量測結果推導出,且該等IMU推導出加速度之各者對應於該車輛的一個別加速度,該IMU係位在該車輛上或該車輛中;在該車輛相關移動資料及該等IMU推導出加速度之一或更多者上進行一或更多運算,以決定在該基於SPS之加速度與該等IMU推導出加速度之該一或更多者之間的一個別相關聯性;將該第一IMU推導出加速度或該第二IMU推導出加速度中與該基於SPS之加速度有一較高相關聯性者的一方向識別為一第一車輛方向;根據該第一車輛方向來決定在一基於地球之座標系統中的一第一基於地球之方向;及根據該第一基於地球之方向來決定該IMU相對於該基於地球之座標系統的一空間校準。
  22. 如請求項第21項所述之電腦可讀取儲存媒體,其中該等IMU推導出加速度進一步包括一第三IMU推導出加速度,以及其中該第一IMU推導出加速度、該第二IMU推導出加速度及該第三IMU推導出加速度為實質上正交。
  23. 如請求項第22項所述之電腦可讀取儲存媒體,其中該等指令當被執行時係進一步可操作以致使該一或更多處理器進行下列步驟:將該等三個IMU推導出加速度中最弱兩者識別為該第一IMU推導出加速度及該第二IMU推導出加速度。
  24. 如請求項第23項所述之電腦可讀取儲存媒體,其中該等指令當被執行時係進一步可操作以致使該一或更多處理器進行下列步驟:將該等三個IMU推導出加速度中最強之一者識別為重力所致之加速度。
  25. 如請求項第21~24項中之任一項所述之電腦可讀取儲存媒體,其中該車輛相關移動資料進一步包括旋轉資料,該旋轉資料係從一或更多陀螺儀所獲得或推導出,該一或更多陀螺儀之各者經安排以量測該IMU的一個別旋轉。
  26. 如請求項第25項所述之電腦可讀取儲存媒體,其中該 等指令當被執行時係進一步可操作以致使該一或更多處理器進行下列步驟:在該旋轉資料及該第一IMU推導出加速度及該第二IMU推導出加速度之一或兩者之間進行一或更多第二相關聯運算。
  27. 如請求項第26項所述之電腦可讀取儲存媒體,其中該等指令當被執行時係進一步可操作以致使該一或更多處理器進行下列步驟:將該第一IMU推導出加速度及該第二IMU推導出加速度中與該旋轉資料有最大相關聯性之一者的方向識別為一第二車輛方向,其中決定該第一基於地球之方向之步驟也至少部分基於該第二車輛方向。
  28. 如請求項第27項所述之電腦可讀取儲存媒體,其中該第一車輛方向對應於該車輛在一基於IMU之座標系統中的一前後移動方向。
  29. 如請求項第28項所述之電腦可讀取儲存媒體,其中該第二車輛方向對應於該車輛在該基於IMU之座標系統中的一右左移動方向。
  30. 如請求項第27項所述之電腦可讀取儲存媒體,其中決定在該基於地球之座標系統中的該第一基於地球之方向 的步驟包括下列步驟:至少部分地根據該第一車輛方向及該第二車輛方向之一或兩者來決定一第一基於車輛之方向;及根據該第一基於車輛之方向來決定在該基於地球之座標系統中的該第一基於地球之方向。
  31. 如請求項第30項所述之電腦可讀取儲存媒體,其中該第一基於車輛之方向對應於該車輛在一第一基於RCU(右、對地航線、上)之座標系統中的一對地航線移動方向。
  32. 如請求項第31項所述之電腦可讀取儲存媒體,其中該等指令當被執行時係進一步可操作以致使該一或更多處理器進行下列步驟:根據該第一車輛方向及該第二車輛方向中之至少一者來決定一第二基於車輛之方向,該第二基於車輛之方向對應於該車輛在該第一基於RCU之座標系統中的一右移動方向。
  33. 如請求項第32項所述之電腦可讀取儲存媒體,其中該等指令當被執行時係進一步可操作以致使該一或更多處理器進行下列步驟:將該第二基於車輛之方向轉換成在該基於地球之座標系統中的一第二基於地球之方向,其中決定該IMU相對 於該基於地球之座標系統的該空間校準的步驟也根據該第二基於地球之方向。
  34. 如請求項第21~24項中之任一項所述之電腦可讀取儲存媒體,其中該速度資料對應於該車輛在一第一基於SPS之座標系統中的移動。
  35. 如請求項第21~24項中之任一項所述之電腦可讀取儲存媒體,其中該基於SPS之加速度及該等IMU推導出加速度為線性加速度。
  36. 如請求項第21~24項中之任一項所述之電腦可讀取儲存媒體,其中該車輛相關移動資料進一步包括從一或更多SPS所獲得之大地測量資料(geodetic data),該大地測量資料對應於該車輛在一第一大地測量座標系統中的一位置。
  37. 如請求項第36項所述之電腦可讀取儲存媒體,其中該等指令當被執行時係進一步可操作以致使該一或更多處理器進行下列步驟:根據該大地測量資料來決定一第一轉換矩陣,該第一轉換矩陣可用以在一基於RCU之座標系統及一基於地球之座標系統之間轉換。
  38. 如請求項第37項所述之電腦可讀取儲存媒體,其中該等指令當被執行時係進一步可操作以致使該一或更多處理器進行下列步驟:根據該車輛相關移動資料來決定一第二轉換矩陣,該第二轉換矩陣可用以在一基於IMU之座標系統及一基於RCU之座標系統之間轉換。
  39. 如請求項第21~24項中之任一項所述之電腦可讀取儲存媒體,其中在由該IMU進行量測期間該IMU為直接或間接可拆卸地固定至該車輛,使得在由該IMU進行量測期間該IMU相對於該車輛的一位置及一校準為恆定。
  40. 如請求項第21~24項中之任一項所述之電腦可讀取儲存媒體,其中該第一IMU推導出加速度及該第二IMU推導出加速度中之一或兩者係利用一特徵向量所推導出。
  41. 一種用於決定一慣性量測單元(IMU)之一空間校準的設備,該IMU經定位於一車輛中或一車輛上,該設備包含:用於取得該車輛之車輛相關移動資料的構件,該車輛相關移動資料包括速度資料,該速度資料係藉由一或更多衛星定位系統(SPS)所量測或從該一或更多SPS所獲得之量測結果推導出,該速度資料包括一基於SPS之加速度;用於取得至少一第一IMU推導出加速度及一第二 IMU推導出加速度的構件,該等IMU推導出加速度之各者係藉由該IMU所量測或從該IMU所獲得之量測結果推導出,且該等IMU推導出加速度之各者對應於該車輛的一個別加速度,該IMU係位在該車輛上或該車輛中;用於在該車輛相關移動資料及該等IMU推導出加速度之一或更多者上進行一或更多運算,以決定在該基於SPS之加速度與該等IMU推導出加速度之該一或更多者之間的一個別相關聯性的構件;用於將該第一IMU推導出加速度或該第二IMU推導出加速度中與該基於SPS之加速度有一較高相關聯性者的一方向識別為一第一車輛方向的構件;用於根據該第一車輛方向來決定在一基於地球之座標系統中的一第一基於地球之方向的構件;及用於根據該第一基於地球之方向來決定該IMU相對於該基於地球之座標系統的一空間校準的構件。
  42. 如請求項第41項所述之設備,其中該等IMU推導出加速度進一步包括一第三IMU推導出加速度,以及其中該第一IMU推導出加速度、該第二IMU推導出加速度及該第三IMU推導出加速度為實質上正交。
  43. 如請求項第42項所述之設備,進一步包含:用於將該等三個IMU推導出加速度中最弱兩者識別為該第一IMU推導出加速度及該第二IMU推導出加速度 的構件。
  44. 如請求項第43項所述之設備,進一步包含:用於將該等三個IMU推導出加速度中最強之一者識別為重力所致之加速度的構件。
  45. 如請求項第41~44項中之任一項所述之設備,其中該車輛相關移動資料進一步包括旋轉資料,該旋轉資料係從一或更多陀螺儀所獲得或推導出,該一或更多陀螺儀之各者經安排以量測該IMU的一個別旋轉。
  46. 如請求項第45項所述之設備,進一步包含:用於在該旋轉資料及該第一IMU推導出加速度及該第二IMU推導出加速度之一或兩者之間進行一或更多第二相關聯運算的構件。
  47. 如請求項第46項所述之設備,進一步包含:用於將該第一IMU推導出加速度及該第二IMU推導出加速度中與該旋轉資料有最大相關聯性之一者的方向識別為一第二車輛方向的構件,其中決定該第一基於地球之方向之步驟也至少部分基於該第二車輛方向。
  48. 如請求項第47項所述之設備,其中該第一車輛方向對應於該車輛在一基於IMU之座標系統中的一前後移動方 向。
  49. 如請求項第48項所述之設備,其中該第二車輛方向對應於該車輛在該基於IMU之座標系統中的一右左移動方向。
  50. 如請求項第47項所述之設備,其中該用於決定在該基於地球之座標系統中的該第一基於地球之方向的構件包括:用於至少部分地根據該第一車輛方向及該第二車輛方向之一或兩者來決定一第一基於車輛之方向的構件;及用於根據該第一基於車輛之方向來決定在該基於地球之座標系統中的該第一基於地球之方向的構件。
  51. 如請求項第50項所述之設備,其中該第一基於車輛之方向對應於該車輛在一第一基於RCU(右、對地航線、上)之座標系統中的一對地航線移動方向。
  52. 如請求項第51項所述之設備,進一步包含:用於根據該第一車輛方向及該第二車輛方向中之至少一者來決定一第二基於車輛之方向的構件,該第二基於車輛之方向對應於該車輛在該第一基於RCU之座標系統中的一右移動方向。
  53. 如請求項第52項所述之設備,進一步包含:用於將該第二基於車輛之方向轉換成在該基於地球之座標系統中的一第二基於地球之方向的構件,其中決定該IMU相對於該基於地球之座標系統的該空間校準的步驟也根據該第二基於地球之方向。
  54. 如請求項第41~44項中之任一項所述之設備,其中該速度資料對應於該車輛在一第一基於SPS之座標系統中的移動。
  55. 如請求項第41~44項中之任一項所述之設備,其中該基於SPS之加速度及該等IMU推導出加速度為線性加速度。
  56. 如請求項第41~44項中之任一項所述之設備,其中該車輛相關移動資料進一步包括從一或更多SPS所獲得之大地測量資料(geodetic data),該大地測量資料對應於該車輛在一第一大地測量座標系統中的一位置。
  57. 如請求項第56項所述之設備,進一步包含:用於根據該大地測量資料來決定一第一轉換矩陣的構件,該第一轉換矩陣可用以在一基於RCU之座標系統及一基於地球之座標系統之間轉換。
  58. 如請求項第57項所述之設備,進一步包含:用於根據該車輛相關移動資料來決定一第二轉換矩陣的構件,該第二轉換矩陣可用以在一基於IMU之座標系統及一基於RCU之座標系統之間轉換。
  59. 如請求項第41~44項中之任一項所述之設備,其中在由該IMU進行量測期間該IMU為直接或間接可拆卸地固定至該車輛,使得在由該IMU進行量測期間該IMU相對於該車輛的一位置及一校準為恆定。
  60. 如請求項第41~44項中之任一項所述之設備,其中該第一IMU推導出加速度及該第二IMU推導出加速度中之一或兩者係利用一特徵向量所推導出。
TW099140046A 2009-11-20 2010-11-19 用於慣性量測單元(imu)的空間校準決定的方法、儲存媒體及設備 TWI457538B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
US12/622,703 US8781737B2 (en) 2009-11-20 2009-11-20 Spatial alignment determination for an inertial measurement unit (IMU)

Publications (2)

Publication Number Publication Date
TW201139987A TW201139987A (en) 2011-11-16
TWI457538B true TWI457538B (zh) 2014-10-21

Family

ID=43588886

Family Applications (1)

Application Number Title Priority Date Filing Date
TW099140046A TWI457538B (zh) 2009-11-20 2010-11-19 用於慣性量測單元(imu)的空間校準決定的方法、儲存媒體及設備

Country Status (7)

Country Link
US (1) US8781737B2 (zh)
EP (1) EP2502026B1 (zh)
JP (1) JP5787896B2 (zh)
KR (1) KR101422374B1 (zh)
CN (1) CN102648394B (zh)
TW (1) TWI457538B (zh)
WO (1) WO2011063280A2 (zh)

Families Citing this family (38)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100318257A1 (en) * 2009-06-15 2010-12-16 Deep Kalinadhabhotla Method and system for automatically calibrating a three-axis accelerometer device
US8781737B2 (en) * 2009-11-20 2014-07-15 Qualcomm Incorporated Spatial alignment determination for an inertial measurement unit (IMU)
RU2010124265A (ru) * 2010-06-16 2011-12-27 Алексей Владиславович Жданов (RU) Способ и устройство определения направления начала движения
DE102011080033A1 (de) * 2010-07-29 2012-02-02 Continental Teves Ag & Co. Ohg Verfahren zur Ermittlung der Fahrtrichtung eines Kraftfahrzeugs
JP5724676B2 (ja) * 2011-06-27 2015-05-27 富士通株式会社 携帯端末装置、速度算出方法及び速度算出プログラム
US8914037B2 (en) 2011-08-11 2014-12-16 Qualcomm Incorporated Numerically stable computation of heading without a reference axis
US9151613B2 (en) * 2011-08-12 2015-10-06 Qualcomm Incorporated Methods and apparatus for detecting, measuring, and mitigating effects of moving an inertial navigation device's cradle
US20130046505A1 (en) * 2011-08-15 2013-02-21 Qualcomm Incorporated Methods and apparatuses for use in classifying a motion state of a mobile device
WO2013049819A1 (en) * 2011-09-30 2013-04-04 Ims Solutions, Inc. A method of correcting the orientation of a freely installed accelerometer in a vehicle
ES2769787T3 (es) * 2012-01-11 2020-06-29 Ultra D Cooeperatief U A Dispositivo de visualización móvil
US8433514B1 (en) * 2012-05-17 2013-04-30 Trimble Navigation, Limited Navigation sensor mounting-angle calibration
US9462632B2 (en) 2012-07-17 2016-10-04 Qualcomm Incorporated Concurrent data streaming using various parameters from the same sensor
US9641266B2 (en) 2012-07-17 2017-05-02 Qualcomm Incorporated Sensor with concurrent data streaming using various parameters
EP3047303A4 (en) * 2013-09-16 2017-05-03 InvenSense, Inc. Method and apparatus for determination of misalignment between device and vessel using radius of rotation
US10302435B2 (en) * 2013-09-17 2019-05-28 Invensense, Inc. Method and system for enhanced navigation with multiple sensors assemblies
US9983224B2 (en) 2014-05-02 2018-05-29 Qualcomm Incorporated Motion direction determination and application
US10281484B2 (en) 2014-05-02 2019-05-07 Qualcomm Incorporated Motion direction determination and application
US9423318B2 (en) * 2014-07-29 2016-08-23 Honeywell International Inc. Motion detection devices and systems
US9886040B1 (en) * 2014-09-24 2018-02-06 Rockwell Collins, Inc. System and method for platform alignment, navigation or targeting
CN104374402B (zh) * 2014-10-23 2018-07-31 哈尔滨工程大学 一种位置未知条件下的星敏感器/加速度计粗对准方法
US9846040B2 (en) 2015-05-08 2017-12-19 Sharp Laboratories Of America, Inc. System and method for determining the orientation of an inertial measurement unit (IMU)
US10503245B2 (en) 2016-09-21 2019-12-10 Apple Inc. Relative intertial measurement system
US10041800B2 (en) 2016-09-23 2018-08-07 Qualcomm Incorporated Pedestrian sensor assistance in a mobile device during typical device motions
US20180128644A1 (en) * 2016-10-03 2018-05-10 Bennett Marine, Inc. Method and apparatus for orientation of inertial measurement unit
US10902312B2 (en) * 2017-03-28 2021-01-26 Qualcomm Incorporated Tracking axes during model conversion
WO2019023913A1 (en) 2017-07-31 2019-02-07 Beijing Didi Infinity Technology And Development Co., Ltd. SYSTEM AND METHOD FOR DETERMINING VEHICLE ORIENTATION
US10948299B1 (en) 2017-09-28 2021-03-16 Apple Inc. Relative inertial measurement system with visual correction
WO2019122987A1 (en) * 2017-12-22 2019-06-27 Shakibay Senobari Mohammad Accurate initialization of strapdown inertial navigation system
CN109216921A (zh) * 2018-09-26 2019-01-15 中天宽带技术有限公司 一种单芯多负载的一拖多天线远程控制单元
GB2578868A (en) * 2018-10-23 2020-06-03 Trak Global Solutions Ltd A method of orientating the output of an accelerometer of a vehicle monitoring apparatus and vehicle monitoring apparatus
CN111121760A (zh) * 2018-10-30 2020-05-08 千寻位置网络有限公司 车载六轴imu轴向快速识别方法及其装置
KR20200140003A (ko) * 2019-06-05 2020-12-15 에스케이텔레콤 주식회사 관성 측정 유닛에 대한 캘리브레이션 장치 및 방법
US11480432B2 (en) 2019-06-27 2022-10-25 Novatel Inc. System and method for IMU motion detection utilizing standard deviation
US20220028262A1 (en) * 2020-07-24 2022-01-27 Lyft, Inc. Systems and methods for generating source-agnostic trajectories
EP3957953A1 (en) 2020-08-19 2022-02-23 Aptiv Technologies Limited System and method for self-test of inertial measurement unit (imu)
US11959774B1 (en) 2020-11-17 2024-04-16 Waymo Llc Extrinsic calibration of sensors mounted on a vehicle
KR102583028B1 (ko) 2021-03-31 2023-09-26 (주)대한엔지니어링 위성항법시스템 및 관성측정장치를 이용한 해양기상관측장비, 그리고 그 장비의 구동법
CN114963873B (zh) * 2022-04-25 2023-07-14 北京自动化控制设备研究所 一种基于加速度信息的旋转弹快速对准方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW382680B (en) * 1998-04-06 2000-02-21 Lin Ching Fang Real-time IMU simulator
US20020165669A1 (en) * 2001-02-28 2002-11-07 Enpoint, L.L.C. Attitude measurement using a single GPS receiver with two closely-spaced antennas
WO2005024457A1 (en) * 2003-09-05 2005-03-17 Novatel Inc. Inertial gps navigation system using injected alignment data for the inertial system
US20070032950A1 (en) * 2005-08-05 2007-02-08 Raven Industries, Inc. Modular high-precision navigation system
EP1983304A2 (en) * 2007-04-16 2008-10-22 Honeywell International Inc. Heading stabilization for aided inertial navigation systems
US20090254279A1 (en) * 2007-06-28 2009-10-08 Shaowei Han Compensation for mounting misalignment of a navigation device

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE1964976C3 (de) * 1969-12-24 1973-01-04 Motoren- Und Turbinen-Union Muenchen Gmbh, 8000 Muenchen Schubumkehrvorrichtung für ein Turbinenstrahltriebwerk eines Flugzeuges
US5991692A (en) * 1995-12-28 1999-11-23 Magellan Dis, Inc. Zero motion detection system for improved vehicle navigation system
US6449559B2 (en) * 1998-11-20 2002-09-10 American Gnc Corporation Fully-coupled positioning process and system thereof
JP4110742B2 (ja) * 2001-03-19 2008-07-02 松下電器産業株式会社 ナビゲーション装置
US8265826B2 (en) * 2003-03-20 2012-09-11 Hemisphere GPS, LLC Combined GNSS gyroscope control system and method
US7337650B1 (en) * 2004-11-09 2008-03-04 Medius Inc. System and method for aligning sensors on a vehicle
SE528484C2 (sv) * 2005-04-11 2006-11-28 Advanced Inertial Measurement Kontrollsystem för fordon
WO2008108788A2 (en) * 2006-05-31 2008-09-12 Trx Systems, Inc. Method and system for locating and monitoring first responders
US7721551B2 (en) * 2006-06-29 2010-05-25 United Technologies Corporation Fan variable area nozzle for a gas turbine engine fan nacelle
JP4641290B2 (ja) * 2006-07-31 2011-03-02 富士通テン株式会社 運転情報記録装置
JP4816340B2 (ja) * 2006-08-31 2011-11-16 ソニー株式会社 ナビゲーション装置、位置検出方法及び位置検出プログラム
EP2074322B1 (en) * 2006-10-12 2013-01-16 United Technologies Corporation Turbofan engine
WO2008045052A1 (en) * 2006-10-12 2008-04-17 United Technologies Corporation Method and device to avoid turbofan instability in a gas turbine engine
EP2064434B1 (en) * 2006-10-12 2012-06-27 United Technologies Corporation Operational line management of low pressure compressor in a turbofan engine
WO2008045079A1 (en) * 2006-10-12 2008-04-17 United Technologies Corporation Turbofan engine operation control
CN101583844B (zh) * 2007-01-18 2011-11-09 三菱电机株式会社 车载导航装置
US7721549B2 (en) * 2007-02-08 2010-05-25 United Technologies Corporation Fan variable area nozzle for a gas turbine engine fan nacelle with cam drive ring actuation system
JP4935427B2 (ja) * 2007-03-01 2012-05-23 ヤマハ株式会社 磁気データ処理装置、方法およびプログラムならびに磁気処理システム。
US8311757B2 (en) * 2007-08-14 2012-11-13 American Gnc Corporation Miniaturized smart self-calibration electronic pointing method and system
US8798214B2 (en) * 2007-11-14 2014-08-05 Qualcomm Incorporated Minimum finger low-power demodulator for wireless communication
US8781737B2 (en) * 2009-11-20 2014-07-15 Qualcomm Incorporated Spatial alignment determination for an inertial measurement unit (IMU)
US8494225B2 (en) * 2010-02-19 2013-07-23 Julian L. Center Navigation method and aparatus
US8843290B2 (en) * 2010-07-22 2014-09-23 Qualcomm Incorporated Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW382680B (en) * 1998-04-06 2000-02-21 Lin Ching Fang Real-time IMU simulator
US20020165669A1 (en) * 2001-02-28 2002-11-07 Enpoint, L.L.C. Attitude measurement using a single GPS receiver with two closely-spaced antennas
WO2005024457A1 (en) * 2003-09-05 2005-03-17 Novatel Inc. Inertial gps navigation system using injected alignment data for the inertial system
US20070032950A1 (en) * 2005-08-05 2007-02-08 Raven Industries, Inc. Modular high-precision navigation system
EP1983304A2 (en) * 2007-04-16 2008-10-22 Honeywell International Inc. Heading stabilization for aided inertial navigation systems
US20090254279A1 (en) * 2007-06-28 2009-10-08 Shaowei Han Compensation for mounting misalignment of a navigation device

Also Published As

Publication number Publication date
TW201139987A (en) 2011-11-16
JP2013511729A (ja) 2013-04-04
EP2502026B1 (en) 2019-01-02
US8781737B2 (en) 2014-07-15
CN102648394B (zh) 2015-12-09
KR20120099468A (ko) 2012-09-10
CN102648394A (zh) 2012-08-22
US20110125404A1 (en) 2011-05-26
EP2502026A2 (en) 2012-09-26
WO2011063280A3 (en) 2011-09-29
JP5787896B2 (ja) 2015-09-30
KR101422374B1 (ko) 2014-07-22
WO2011063280A2 (en) 2011-05-26

Similar Documents

Publication Publication Date Title
TWI457538B (zh) 用於慣性量測單元(imu)的空間校準決定的方法、儲存媒體及設備
US8633817B2 (en) Mapping wireless signals with motion sensors
JP4989035B2 (ja) 慣性ナビゲーションシステムの誤差補正
JP5586994B2 (ja) 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム
CN110221328A (zh) 一种组合导航方法和装置
JP4746374B2 (ja) 位置補正方法及びナビゲーション装置
US20100274481A1 (en) System and method for collaborative navigation
CN106842271B (zh) 导航定位方法及装置
KR20110043538A (ko) 영상 지도의 구축 및 차량 위치 결정을 위한 방법 및 시스템
US20230358541A1 (en) Inertial navigation system capable of dead reckoning in vehicles
JP2012203721A (ja) 相対位置推定装置及びプログラム
CN109579870A (zh) 捷联惯导系统的自动对准方法和组合导航装置
US20140249750A1 (en) Navigational and location determination system
EP4257928A2 (en) Method and apparatus for in motion initialization of global navigation satellite system - inertial navigation system
WO2010030565A1 (en) Magnetic sensing device for navigation and detecting inclination
US10006770B2 (en) Remote location determination system
JP5994237B2 (ja) 測位装置及びプログラム
CN109827572A (zh) 一种检测车位置预测的方法及装置
Farroni et al. A comparison among different methods to estimate vehicle sideslip angle
TW202212777A (zh) 提升的航位推算精度
JP5062141B2 (ja) 移動体用測位装置
Sun et al. Analysis of the Kalman filter with different INS error models for GPS/INS integration in aerial remote sensing applications
Zeng An IMU-Aided Carrier-Phase Differential GPS Positioning System
JP2015184011A (ja) 位置照合装置、位置照合方法及びプログラム
Renaudin Personal navigation with handheld devices

Legal Events

Date Code Title Description
GD4A Issue of patent certificate for granted invention patent