一種多維度精確定位方法與流程
2023-06-03 18:29:21 2
本發明涉及一種專用於面向代駕系統的多維度精確定位方法。
背景技術:
隨著汽車產業的快速擴張,成本下降,使得很多家庭都有能力購買和使用汽車。並且個人、商務等需求,催生了代駕產業,主要分為酒後代駕、長途代駕和商務代駕。市面上諸多代駕系統導航絕大部分是依賴於GPS衛星定位,這種定位方式需要30秒啟動時間,同時在天氣狀態不佳時定位會有偏差,而在沒有GPS定位時,直接使用基站定位,並不能獲得精確的定位信息。
技術實現要素:
本發明要解決的技術問題:針對現有的定位方法存在上述的問題,提供了一種利用多種方式共同定位的方法。
本發明技術方案:
一種多維度精確定位方法,包括具備網絡定位功能、WIFI連接定位功能和GPS定位功能的裝置,包括以下步驟:一,通過基站獲取基站定位位置L1;二,通過WIFI熱點獲取WIFI定位位置L2;三,通過GPS獲取GPS定位位置L3,四,以L1、L2和L3作為基點應用Trilateration定位算法計算出定位位置L4。
對L4通過中位值濾波對定位信息進行過濾,再進行平滑濾波,最後進行Kalman濾波。
本發明的有益效果:
本發明通過使用多種定位手段計算出多種帶有偏差的定位信息,然後對這些帶有偏差的定位信息作進一步處理得到最終的高精度定位坐標。
具體實施方式:
實施例1:本實施例中網絡定位功能、WIFI連接定位功能和GPS定位功能的裝置為智慧型手機,手機中安裝有計算軟體,計算步驟如下:
a)軟體利用手機的網絡定位功能,查找周邊大於三個的基站定位與信號強度信息;使用Trilateration定位算法,逐次計算出基站定位數據,得到一個含有精度的定位數據L1;
b)連接周邊多個開放具有定位信息的WIFI連接,獲取WIFI定位數據與信號強度信息;通過Trilateration定位算法,逐次計算出WIFI定位數據。得到一個含有精度的定位數據L2;
c)用GPS定位獲取定位信息L3;
d)使用堆方式存儲上述搜集到的3種數據,對三個定位值再進行Trilateration定位算法完成融合計算。得到值L4;
e)對L4通過中位值濾波對定位信息進行過濾,再進行平滑濾波然後進行Kalman濾波,求出精度較高的位置信息。
在步驟d)中使用Trilateration定位算法時,以L1、L2和L3做為三個基點,以3種定位方式的精度做為手機到三個基點的距離,以此求出手機的最終位置。