?

　　(2)

　　其中:

　　g … 地球重力，9.81m/s2

　　GYRO_bias … 陀螺儀長(zhǎng)期偏差穩(wěn)定性，單位：rad/s

　　T … 雙重積分周期，單位：秒

　　PE_ACC … GYRO_bias造成的位置誤差;單位：米。

　　以上兩個(gè)方程式可用于計(jì)算典型慣性傳感器的性能和長(zhǎng)期偏差穩(wěn)定性引起的水平位置誤差。當(dāng)慣性傳感器與GPS集成在一起時(shí)，這些誤差不會(huì)隨時(shí)間推移而擴(kuò)大，其它引起位置誤差的因素，如失匹、非線性和溫度影響，也應(yīng)在計(jì)算中給予考慮。

　　最近在MEMS制程上取得的進(jìn)步讓 MEMS加速度計(jì)和陀螺儀能夠連續(xù)地提供更高的定位性能，使商用級(jí)的產(chǎn)品更加接近戰(zhàn)術(shù)級(jí)產(chǎn)品的性能。在較短的時(shí)間如1分鐘內(nèi)，獨(dú)立的加速度計(jì)和陀螺儀可取得相對(duì)較高的測(cè)量精度。當(dāng)GPS信號(hào)受阻時(shí)，這對(duì)于GPS/SINS一體化導(dǎo)航系統(tǒng)很有用。

　　對(duì)于消費(fèi)電子產(chǎn)品，室內(nèi)行人航位推算系統(tǒng)5%的行進(jìn)距離誤差通常是可以接受的。例如，當(dāng)一個(gè)人走過(guò)100米的距離時(shí)，定位誤差應(yīng)該在5米范圍內(nèi)。這要求航向誤差在 ±2°到±5°之間[2]。例如，如果航位誤差是2°，當(dāng)一個(gè)人走過(guò)100米的距離時(shí)，定位誤差應(yīng)該在3.5米范圍內(nèi) [= 2*100m*sin(2°/2)]。

　　此外，MEMS壓力傳感器能夠測(cè)量相對(duì)于海平面的絕對(duì)氣壓。因此，MEMS傳感器可以確定手機(jī)用戶在海平面以下 600米到海平面以上 9000米之間的高度，輔助GPS的高度測(cè)量[2]。圖3所示是利用MEMS傳感器與GPS接收器的行人航位推算系統(tǒng)結(jié)構(gòu)圖。

　　圖 3: 移動(dòng)設(shè)備行人航位推算系統(tǒng)結(jié)構(gòu)圖

?

　　MEMS傳感器整合

　　傳感器整合是一套數(shù)字濾波算法，用于修正每個(gè)獨(dú)立傳感器的缺陷，然后輸出精確的響應(yīng)快速的動(dòng)態(tài)的(俯仰/滾轉(zhuǎn)/偏航)姿態(tài)測(cè)量結(jié)果。傳感器整合的目的是把每個(gè)傳感器的測(cè)量數(shù)據(jù)作為輸入數(shù)據(jù)，然后應(yīng)用數(shù)字過(guò)濾算法對(duì)輸入數(shù)據(jù)進(jìn)行相互修正，最后輸出精確的響應(yīng)快速的動(dòng)態(tài)的姿態(tài)測(cè)量結(jié)果。因此，航向或方位不受環(huán)境磁干擾的影響，沒(méi)有陀螺儀的零偏漂移問(wèn)題。

　　能夠修正傾斜度的數(shù)字羅盤(pán)是由一個(gè)3軸加速度計(jì)和一個(gè)3軸磁力計(jì)組成，可提供以地球北極為參考的航向信息。但是這個(gè)航向信息容易受到環(huán)境磁力的干擾。如果安裝一個(gè)3軸陀螺儀，開(kāi)發(fā)一個(gè)9軸傳感器整合解決方案，則可以隨時(shí)隨地保持精確的航向信息。

　　在設(shè)計(jì)一個(gè)使用多個(gè)MEMS傳感器的系統(tǒng)時(shí)，了解下表所列的每個(gè)MEMS傳感器的優(yōu)缺點(diǎn)是很重要的。

　　?加速度計(jì):在靜態(tài)或慢速運(yùn)動(dòng)狀態(tài)下可用于傾斜度修正型數(shù)字羅盤(pán);可用于計(jì)步器的檢測(cè)功能，檢測(cè)步行人當(dāng)前的狀態(tài)是靜止還是運(yùn)動(dòng)。不過(guò)，當(dāng)系統(tǒng)在3D空間靜止時(shí)，加速度計(jì)無(wú)法區(qū)分真正的線性加速度與地球重力，而且容易受到震動(dòng)和振蕩的影響。

　　?陀螺儀:可以連續(xù)提供從系統(tǒng)載體坐標(biāo)到局部地球水平坐標(biāo)的旋轉(zhuǎn)矩陣，當(dāng)磁力計(jì)受到干擾時(shí)，陀螺儀可輔助數(shù)字羅盤(pán)計(jì)算航向數(shù)據(jù)。長(zhǎng)時(shí)間的零偏漂移導(dǎo)致無(wú)限制的姿態(tài)和定位錯(cuò)誤。

　　?磁力計(jì):可計(jì)算以地球北極為參考方向的絕對(duì)航向，并且可用于校準(zhǔn)陀螺儀的靈敏度，但容量受到環(huán)境磁場(chǎng)的干擾。

　　?壓力傳感器:在室內(nèi)導(dǎo)航時(shí)，壓力傳感器可告訴你身處哪一樓層，輔助GPS計(jì)算高度;當(dāng)GPS信號(hào)變?nèi)鯐r(shí)，輔助GPS提高定位精度，但是容易受到氣流和天氣狀況的影響。

　　基于以上各方面考慮，卡爾曼濾波器是最常用的整合不同的傳感器輸入信息的數(shù)學(xué)方法。這種方法權(quán)衡不同的傳感器的作用，給性能最高的方面最高權(quán)數(shù)，因此，與基于單一媒介的導(dǎo)航系統(tǒng)相比，卡爾曼濾波器算法的估算結(jié)果更精確可靠 [3]。

　　目前基于四元數(shù)的擴(kuò)展型卡爾曼濾波器(EKF)是一個(gè)很受歡迎的傳感器整合方案，因?yàn)樗脑獢?shù)只有4個(gè)元素，而旋轉(zhuǎn)矩陣有9個(gè)元素，此外，四元數(shù)法還避免了旋轉(zhuǎn)矩陣的特殊問(wèn)題 [3]。

　　4.結(jié)論

　　隨時(shí)隨地精確定位是增強(qiáng)實(shí)境等先進(jìn)移動(dòng)應(yīng)用面臨的主要挑戰(zhàn)，因?yàn)樵鰪?qiáng)實(shí)境與行人航位推算(PDR)或定位服務(wù)(LBS)的關(guān)系密切。鑒于GPS接收器的接收限制，MEMS傳感器對(duì)室內(nèi)行人航位推算應(yīng)用很有吸引力，因?yàn)檫@些傳感器大多數(shù)已經(jīng)出現(xiàn)在智能手機(jī)內(nèi)。

　　要想取得5%的室內(nèi)行人航位推算定位誤差，需要開(kāi)發(fā)MEMS傳感器整合算法，以修正每個(gè)傳感器的缺陷，使這些傳感器實(shí)現(xiàn)優(yōu)勢(shì)互補(bǔ)。隨著MEMS傳感器的性能不斷提高，在不遠(yuǎn)的將來(lái)，與用戶無(wú)關(guān)的SINS/GPS一體化導(dǎo)航系統(tǒng)將會(huì)成為智能手機(jī)的標(biāo)準(zhǔn)配置。