【導(dǎo)讀】提起定位導(dǎo)航，大家首先想到的是GPS，中國也推出了自己的衛(wèi)星定位系統(tǒng)北斗衛(wèi)星定位系統(tǒng)。但是衛(wèi)星定位只能用在室外環(huán)境，一到室內(nèi)，由于導(dǎo)航信號衰減太快，衛(wèi)星定位就無法使用。在本文中，作者結(jié)合自己的工作經(jīng)驗談了談微慣導(dǎo)定位方案，以及為什么選擇這個方案背后的緣由。
那么，室內(nèi)定位當前有沒有“剛需”呢？答案是肯定的。今天我們不談現(xiàn)在很熱鬧的消費級市場應(yīng)用，我們談下室內(nèi)定位技術(shù)在一些特殊但很重要的場景——消防救援、反恐處突、搶險救災(zāi)等應(yīng)急任務(wù)中的應(yīng)用。
消防救援等應(yīng)急任務(wù)對室內(nèi)定位技術(shù)的特殊需求
試想一下這樣的場景：大火現(xiàn)場，消防員沖進著火的大樓里試圖搜救幸存者，火勢越來越猛烈，煙霧彌漫，消防員迷路找不到出口，氧氣不夠，最終喪失了生命……
如果能精確定位消防員的位置，后方指揮人員掌握了進入火場施救的消防員實時動向，通過通信設(shè)備向現(xiàn)場人員提供準確指揮，避免消防員在火場中迷路，可以最大程度地減少人員傷亡。這對于室內(nèi)定位技術(shù)來說，也是功德一件了。
目前業(yè)內(nèi)主流室內(nèi)定位技術(shù)普遍需要外部設(shè)施或先驗數(shù)據(jù)庫，比如UWB、WiFi、藍牙、地磁等，而消防救援等應(yīng)急任務(wù)通常來不及或環(huán)境不允許布置外部定位基站或信標等設(shè)備，因此沒有一種可以滿足緊急任務(wù)下自主定位的要求，所以采用不依賴任何外部設(shè)備或先驗數(shù)據(jù)庫的慣導(dǎo)定位技術(shù)是目前比較穩(wěn)妥的手段。慣導(dǎo)定位技術(shù)是一種完全自主式的導(dǎo)航技術(shù)，與普通的定位技術(shù)不同的是，它不依賴于導(dǎo)航衛(wèi)星、無線基站、電子標簽等任何輔助設(shè)備和先驗數(shù)據(jù)庫。
對于應(yīng)急任務(wù)室內(nèi)定位需求來說，定位產(chǎn)品是否能達到實戰(zhàn)效果應(yīng)該從以下幾個方面評估或者實際測試：
1、 是否可以適應(yīng)多種步態(tài)，典型步態(tài)有小碎步走、小跑、側(cè)移、倒退、上下樓等；
2、 沿長直線走50米以上，到末端轉(zhuǎn)５個以上圓圈（半徑２米以上），再沿原直線走回，評估偏移量，偏移量控制在１%以內(nèi)的則為優(yōu)秀產(chǎn)品（慣導(dǎo)存在無法消除的固定角度和位置漂移，只能盡可能降低；
3、 反復(fù)上下樓梯，評估高度準確度，尤其是樓層判定，看看會不會出現(xiàn)樓層錯誤，小誤差可以接受，但是樓層判錯會延誤救援甚至造成致命失誤；
4、 在建筑物內(nèi)進行實地測試，磁場是慣導(dǎo)室內(nèi)定位的一個重要信息，可以用來控制慣導(dǎo)的漂移。但是也容易受到外界影響，尤其是建筑物比較緊湊，金屬結(jié)構(gòu)比較多，有大型顯示屏的環(huán)境，應(yīng)評估定位產(chǎn)品磁場抗干擾特性；
5、 有條件的可以進行點火試驗，大火會造成溫度和氣流的急劇變化，如果氣壓計數(shù)據(jù)融合沒有處理好，高度會有很大偏差，簡易測試方法是通過空調(diào)調(diào)節(jié)室內(nèi)外溫差，通過出入室內(nèi)外測試定位的穩(wěn)定性；
6、 使用是否便捷、是否需要外部基站輔助都可以評估，在消防救援等應(yīng)急任務(wù)中不能完全依賴于任何外部基站，我們的微慣導(dǎo)定位產(chǎn)品GNW-FOEM在無外部基站輔助情況下可以保持45分鐘左右的精度可用，在同類產(chǎn)品中比較出眾；
7、 地圖融合算法的優(yōu)劣，無地圖和有地圖的情況使用評估，我們的iNav智能定位引擎提供了地圖輸入接口，在有室內(nèi)地圖信息的條件下，可以長時間保持高精度不漂移，做過的典型試驗是在商場內(nèi)，1小時內(nèi)精度穩(wěn)定在2米；
8、 數(shù)據(jù)通信方式的選擇，大致分為兩類情況，一種是利用運營商網(wǎng)絡(luò)外傳（利用基礎(chǔ)網(wǎng)絡(luò)的覆蓋冗余性和其穩(wěn)健的通信機制），一種是利用專用網(wǎng)絡(luò)，但是目前還沒有一種可以快速部署又便捷可穿戴，能夠覆蓋消防救援的專用通訊網(wǎng)絡(luò)（通常能達到覆蓋地下一層就已經(jīng)算性能達標了），如果產(chǎn)品能兼容運營商網(wǎng)絡(luò)和專用網(wǎng)絡(luò)就已經(jīng)是一種比較好的方式了。
一種比較可行的產(chǎn)品配置方案是1個主控端 + 4-8個單兵節(jié)點配置，如圖：
圖1 應(yīng)急任務(wù)現(xiàn)場指揮系統(tǒng)方案圖
每個單兵配備一個定位模塊（足部）和手持終端，模塊獲取人員運動數(shù)據(jù)后，通過藍牙通訊傳給手持終端，手持終端通過遠場通訊設(shè)備將數(shù)據(jù)傳遞給指揮中心。系統(tǒng)可融入室內(nèi)地圖，水平精度達到0.3%，能準確進行樓層識別。現(xiàn)場、后場多個指揮端可同步顯示，有利于消防員現(xiàn)場指揮調(diào)度、減少人員傷亡現(xiàn)場，事后可實現(xiàn)任務(wù)回放，進行教學(xué)和經(jīng)驗總結(jié)。
微慣導(dǎo)室內(nèi)定位技術(shù)在應(yīng)急任務(wù)中具有無可替代的優(yōu)勢
在應(yīng)急任務(wù)場合，業(yè)內(nèi)主流室內(nèi)定位技術(shù)普遍需要外部設(shè)施，大多數(shù)無法滿足緊急情況下自主定位的要求。在這種情況下，首先想到的就是慣導(dǎo)室內(nèi)定位技術(shù)。基于此，市場上也涌現(xiàn)了一批做慣導(dǎo)定位的公司。
國外的代表公司有Honeywell、SEER Technology，產(chǎn)品的定位精度基本上為2%-5%，也就是說用戶行走1km，位置誤差為20米，這是無法滿足實際應(yīng)用需求的，會延誤逃生、救援等和位置精度密切相關(guān)的應(yīng)急任務(wù)，整個產(chǎn)品沒有達到真正實戰(zhàn)的技術(shù)指標。因此這部分產(chǎn)品也因技術(shù)不成熟而未能打開市場。
國內(nèi)也有幾家公司在做，如微邁森，和筆者所在的格納微科技等。其中，我們的產(chǎn)品定位精度達到了0.3%，相當于走1公里誤差不到3米，可以適應(yīng)<15km/h的走路、小跑、側(cè)移、后退等任意步行姿態(tài)，基本可以滿足實際應(yīng)用需求了。
一般人對于0.3%精度仍有質(zhì)疑，其實產(chǎn)品采用的是普通的低成本MEMS方案，就是智能手機中的G-sensor，而且不依靠任何基站等輔助信息。這種低成本的MEMS器件，通常會有極高的方向漂移誤差（≥100°/h）和加速度誤差，如果僅采用普通的航位推算算法，加速度積分帶來的速度和位移誤差將高達10%以上。
微慣導(dǎo)室內(nèi)定位技術(shù)目前發(fā)展比較快，主要是用于緊急救援或者軍事用途，大概分為兩種：
- 佩戴于腰部的慣導(dǎo)模塊，采用傳統(tǒng)PDR航位推算方案；
- 佩戴于足部的慣導(dǎo)模塊，基于足部運動模型開發(fā)，精度較高；
腰上的方案實用性更強，但是對于側(cè)移、轉(zhuǎn)彎、原地踏步等步態(tài)就會產(chǎn)生明顯的誤差積累。目前我們的腰部慣導(dǎo)產(chǎn)品的實驗結(jié)果是2%的精度，走100米誤差達到2m。業(yè)內(nèi)比較知名的Honeywell的DRM4000（圖2）和SEER Technology的NAViSEER（圖3）都是采用這類技術(shù)方案，實測精度大約在2%～5%。腰部慣導(dǎo)定位模塊無法適應(yīng)特殊步態(tài)，實戰(zhàn)應(yīng)用受限，希望后期能看到更為優(yōu)秀的產(chǎn)品和技術(shù)出現(xiàn)。
圖2 DRM4000航位推算模塊 圖3 NAViSEER人員精確跟蹤系統(tǒng)
足部的方案精度高，相對穩(wěn)定，如果能夠穩(wěn)定在0.3%以內(nèi)的精度，基本能滿足應(yīng)急任務(wù)的需求了，消防、反恐、救援任務(wù)在建筑物內(nèi)行走距離不長，行走1km誤差累計3m，用戶基本都可以接受。
“ 微慣導(dǎo) + ”融合定位解決方案
純慣導(dǎo)定位在室內(nèi)小場景，經(jīng)過長時間的行走后，角度和位置漂移并不明顯，因此在很多使用場景中并沒有使用其它輔助定位手段。但是這種純慣導(dǎo)定位產(chǎn)品依然有兩個弱點：
一是輸出為相對軌跡，需要將多個人員的軌跡統(tǒng)一到一個坐標系中，目前使用較多的做法是所有應(yīng)急任務(wù)人員在出發(fā)時經(jīng)過同一段長直線，在應(yīng)用層將軌跡旋轉(zhuǎn)到統(tǒng)一坐標。第二種做法大概是部署兩個腳墊（相隔至少10米以上），所有隊員依次踩兩個腳墊，可以通過后臺自動旋轉(zhuǎn)將多個隊員統(tǒng)一到一個坐標。
二是就純慣導(dǎo)定位的精度來說，目前業(yè)內(nèi)0.3%的精度相對比較高，但在大場景長距離情況下，由于慣導(dǎo)固有的漂移率，仍然會有較大的累積誤差（如圖4所示），需要外部的信息進行校準。
針對這兩大問題，我這里分享下我們的兩種解決方案，給大家做個參考：
(1) 通過地圖匹配輔助微慣導(dǎo)定位；
(2) 采用外部藍牙基站輔助微慣導(dǎo)定位。
如果可以獲取應(yīng)急任務(wù)場景的建筑物室內(nèi)地圖信息，結(jié)合地圖匹配技術(shù)，利用基于地圖信息的粒子濾波自動學(xué)習(xí)路徑算法，校準慣導(dǎo)定位中的殘余誤差并標定多個，實現(xiàn)長時間穩(wěn)定定位，可進一步減少輔助定位基站數(shù)量，降低定位系統(tǒng)復(fù)雜度。
采用外部藍牙基站輔助定位，我們目前是以微慣導(dǎo)定位為主，通過間或獲取的基站藍牙信號進行校準，被定位人員在建筑物內(nèi)結(jié)合自身的慣導(dǎo)數(shù)據(jù)和間或獲取的基站信息，來獲取一個穩(wěn)定的高精度定位結(jié)果，同時實現(xiàn)了多人軌跡標定，實際測試結(jié)果體驗就會比較好。這里需要考慮一個問題，就是輔助基站布設(shè)的靈活性和快捷性。
藍牙也可用于室內(nèi)定位，但是信號發(fā)射范圍比較小，而且容易受到環(huán)境包括人體的遮擋和干擾，定位精度不高，一般在3米左右；但藍牙設(shè)備輕巧，成本低，布設(shè)起來較為方便，這對于應(yīng)急任務(wù)來說是一大優(yōu)勢。所以以高精度慣導(dǎo)定位為主，輔以便于臨時布設(shè)的藍牙信標，有望解決應(yīng)急任務(wù)場合的室內(nèi)定位現(xiàn)場快速部署的問題。
下面是采用高精度的微慣導(dǎo)定位模塊結(jié)合藍牙信標做的外場試驗，通過自主開發(fā)的iNav智能定位引擎進行數(shù)據(jù)融合。
圖4 純慣導(dǎo)定位的結(jié)果 圖5 慣導(dǎo)+藍牙定位的結(jié)果
在一個大型百貨商場中，面積約200米*300米的范圍內(nèi)總共只部署了3個藍牙信標，圖5中紅色所標示的為信標的位置。進行了約1個半小時的自由行走，總計行程約6km，沒有借助任何地圖信息，可以實現(xiàn)長時間的高精度定位，定位誤差最大的地方達到3.6米，90%以上時間定位誤差均在2米內(nèi)。慣導(dǎo)定位精度再高也是有漂移的，尤其在這種大場景下，1～2°的角度偏差就可以造成6～8米的位移偏差，藍牙信標和慣導(dǎo)的數(shù)據(jù)經(jīng)過iNav引擎融合優(yōu)化后，將多人相對軌跡迅速統(tǒng)一到第一個人的坐標系，并且實現(xiàn)穩(wěn)健的高精度定位。
其實講到這里，我們選擇提出“微慣導(dǎo)+藍牙”室內(nèi)定位解決方案的原因就很簡單了——部署簡便，間或校準慣導(dǎo)漂移，自動實現(xiàn)多人軌跡方向?qū)R，無需任何地圖信息融合，長時間維持在一個穩(wěn)定的可接受的精度范圍，是非常適合應(yīng)急任務(wù)室內(nèi)場景的。
實際使用時，第一個進入室內(nèi)的應(yīng)急任務(wù)人員，在室內(nèi)一些關(guān)鍵位置（大門、樓梯拐角等）隨意放置3～4個藍牙，即可完成部署，后續(xù)隊員的定位結(jié)果都可以依靠這幾個藍牙小標簽起作用。
室內(nèi)定位技術(shù)種類較多，但單靠一種技術(shù)無法完全解決實際問題，也無法同時滿足成本低、精度高、覆蓋廣的需求。在未來相當長一段時間內(nèi)，微慣導(dǎo)定位將是應(yīng)急任務(wù)室內(nèi)定位解決方案中的核心技術(shù)。
本文來源于雷鋒網(wǎng)。
推薦閱讀：
