多傳感器融合定位在高速鐵路的應(yīng)用2

　　(1)由局部濾波器l處理GPS接收機(jī)輸出的列車位置信息，并給出狀態(tài)估計(jì)x1和估計(jì)誤差的協(xié)方差矩陣p1；

　　(2)局部濾波器2處理陀螺儀和里程儀輸出的角度信息x2和列車運(yùn)行距離信息，給出狀態(tài)估計(jì)和估計(jì)誤差的協(xié)方差矩陣p2；

　　(3)局部濾波器3處理查詢應(yīng)答器輸出的進(jìn)路長度等信息，給出狀態(tài)估計(jì)x3和估計(jì)誤差的協(xié)方差矩陣p3；

　　(4)x1，x2，x3，及p1，p2，p3被送到主濾波器，并同主濾波器的狀態(tài)估計(jì)一起按式(1)和式(2)進(jìn)行融合，得到全局最優(yōu)估計(jì)和協(xié)方差矩陣

　　(5)利用主濾波器的最優(yōu)估計(jì)值對3個(gè)子濾波器的狀態(tài)估計(jì)進(jìn)行重置。即

　　2．2．3 信息分配參數(shù)的選擇

　　不同的信息分配系數(shù)可以獲得聯(lián)邦濾波器的不同結(jié)構(gòu)以及不同的容錯(cuò)性能、濾波精度和計(jì)算量。本方案中設(shè)計(jì)了一種自適應(yīng)聯(lián)邦卡爾曼濾波器。利用GPS接收機(jī)輸出的反映定位精度的參數(shù)為依據(jù)，自動(dòng)調(diào)整P值的大小。本定位系統(tǒng)根據(jù)GPS接收機(jī)的p值大小來決定取值。具體的自適應(yīng)算法為

2．3 地圖匹配

　　GPS和DR系統(tǒng)的組合導(dǎo)航在一定程度上提高了定位系統(tǒng)的精度和可靠性，但定位數(shù)據(jù)仍然存在一定誤差，并且當(dāng)GPS數(shù)據(jù)丟失時(shí)，DR系統(tǒng)的誤差會(huì)累積變大。在實(shí)際系統(tǒng)中通常采用地圖匹配算法來進(jìn)一步提高GPS和DR系統(tǒng)的精度。

　　地圖匹配的基本思想是將車輛定位軌跡與數(shù)字地圖中的道路網(wǎng)信息聯(lián)系起來，并由此相對于地圖確定車輛的位置。地圖匹配的算法分為兩個(gè)相對獨(dú)立的過程：一是道路選擇，主要是對道路進(jìn)行分段，提取道路特征信息，然后采用適當(dāng)?shù)乃阉饕?guī)則和匹配算法根據(jù)當(dāng)前傳感器給出的車輛信息，在地圖數(shù)據(jù)庫中尋找一條最有可能的道路；二是道路匹配，將車輛當(dāng)前位置匹配并顯示在這條道路上，用于消除傳感器的定位誤差。