基于改進(jìn)卡爾曼濾波和狀態(tài)觀測(cè)器的井下信號(hào)燈閉鎖控制

關(guān)鍵詞：非煤礦山；井下斜坡道運(yùn)輸；信號(hào)燈閉鎖控制；UWB；車輛定位；信號(hào)燈邏輯判定；強(qiáng)跟蹤卡爾曼濾波；狀態(tài)觀測(cè)器

中圖分類號(hào)：TD525 文獻(xiàn)標(biāo)志碼：A

0引言

隨著斜坡道建設(shè)技術(shù)的完善及無(wú)軌車輛在非煤礦山的廣泛運(yùn)用，眾多礦山已經(jīng)建立了用于運(yùn)輸?shù)男逼碌繹1-3]。然而，由于斜坡道施工難度和成本限制，國(guó)內(nèi)井下斜坡道大多為單行道。除常規(guī)岔路口外，為便于井下無(wú)軌膠輪車錯(cuò)車，斜坡道每隔一定距離便設(shè)有避讓路口，加之斜坡道路線的復(fù)雜性，導(dǎo)致井下斜坡道的輔助運(yùn)輸和監(jiān)管變得復(fù)雜[4-5]。此外，井下還存在運(yùn)輸管理不嚴(yán)和司機(jī)安全意識(shí)不足等問(wèn)題。若沒有系統(tǒng)的有效監(jiān)管和引導(dǎo)，時(shí)常發(fā)生超速、闖紅燈、交通堵塞等現(xiàn)象，甚至導(dǎo)致碰撞等事故。因此，斜坡道輔助運(yùn)輸車輛管控系統(tǒng)成為礦山安全運(yùn)營(yíng)中不可或缺的重要組成部分[6-8]。

信號(hào)燈閉鎖控制系統(tǒng)作為斜坡道輔助運(yùn)輸系統(tǒng)的重要組成部分，對(duì)于確保無(wú)軌膠輪車安全行駛起到至關(guān)重要的作用[9-11]。信號(hào)燈閉鎖控制系統(tǒng)的基礎(chǔ)是車輛定位。最簡(jiǎn)單、最早使用的定位方式是地感線圈，通過(guò)地感線圈檢測(cè)固定位置是否有車輛經(jīng)過(guò)，再通過(guò)PLC 統(tǒng)計(jì)閉鎖區(qū)間內(nèi)的車輛數(shù)量，結(jié)合線圈感應(yīng)順序?qū)崿F(xiàn)信號(hào)燈判定[12]。但地感線圈只能實(shí)現(xiàn)定點(diǎn)檢測(cè)，無(wú)法進(jìn)行車輛識(shí)別。李朝金[13]采用RFID 車輛識(shí)別技術(shù)，通過(guò)車卡與基站的數(shù)據(jù)通信來(lái)區(qū)分車輛。佘九華等[14]提出采用位置傳感器判斷車輛位置的方法，較地感線圈定位范圍大，可實(shí)現(xiàn)井下全范圍車輛定位。隨著無(wú)線通信技術(shù)的發(fā)展，ZigBee、WiFi 和UWB 等被應(yīng)用到煤礦井下定位中[15-17]。其中，UWB 技術(shù)具有較高的靜態(tài)定位精度，但其動(dòng)態(tài)定位精度會(huì)隨著速度提高而降低。

信號(hào)燈閉鎖控制系統(tǒng)的另一個(gè)關(guān)鍵是控制邏輯。米彥軍[18]提出的閉鎖控制邏輯，可有效解決車輛“頂牛”問(wèn)題，但邏輯僅限于閉鎖區(qū)間，缺少提前警示功能，易造成后發(fā)司機(jī)看到紅燈后倒車的問(wèn)題。包翔宇等[19]提出的車輛放行邏輯適用于視線不好的復(fù)雜路口，實(shí)際車輛放行效率較低，易造成車輛等待時(shí)間過(guò)長(zhǎng)的問(wèn)題。

針對(duì)上述問(wèn)題，本文提出一種基于改進(jìn)卡爾曼濾波和狀態(tài)觀測(cè)器的井下信號(hào)燈閉鎖控制算法。結(jié)合非煤礦山井下斜坡道運(yùn)輸?shù)膶?shí)際情況，提出了井下信號(hào)燈控制邏輯規(guī)則，可避免井下常見的錯(cuò)車問(wèn)題，提高斜坡道運(yùn)輸效率；通過(guò)強(qiáng)跟蹤卡爾曼濾波進(jìn)行UWB 定位數(shù)據(jù)處理，以提高動(dòng)態(tài)定位精度；通過(guò)預(yù)測(cè)到達(dá)門限時(shí)間，保證邏輯判定與信號(hào)燈響應(yīng)的及時(shí)性；最后采用基于結(jié)果分析的遠(yuǎn)程狀態(tài)觀測(cè)器評(píng)估算法性能。

1基于UWB的車輛定位原理

采用UWB 技術(shù)進(jìn)行車輛定位，測(cè)距采用雙向飛行時(shí)間法，靜態(tài)定位誤差小于0.3 m，可視覆蓋范圍達(dá)400 m。位于直線上的車輛僅需2 個(gè)定位接收器即可完成定位，因此，將2 個(gè)UWB 定位模塊合并放入定位分站中，分站左右兩端各連接1 個(gè)5 m 長(zhǎng)的定位天線（圖1）用于接收和發(fā)送數(shù)據(jù)。圖1 中，紅色為遠(yuǎn)路口天線，藍(lán)色為近路口天線。

2井下信號(hào)燈邏輯判定方法

2.1邏輯判定基本參數(shù)

進(jìn)行信號(hào)燈邏輯判定時(shí)，首先要確定車輛行駛狀態(tài)。車輛行駛狀態(tài)可分為靜止?fàn)顟B(tài)、駛?cè)肼房跔顟B(tài)、駛離路口狀態(tài)3 種。定位分站采集到連續(xù)離散定位數(shù)據(jù)并進(jìn)行分析，推斷出車輛行駛狀態(tài)。車輛行駛狀態(tài)判定流程如圖5 所示。當(dāng)分站檢測(cè)到車輛連續(xù)2 組定位數(shù)據(jù)后，通過(guò)計(jì)算車速判定車輛是否靜止，若為非靜止?fàn)顟B(tài)，再基于前后位置變化判定是駛?cè)脒€是駛離路口。

除車輛行駛狀態(tài)外，系統(tǒng)還需要根據(jù)車輛不同位置做出不同邏輯判定。基于判定邏輯，車輛位置可劃分為入列、關(guān)聯(lián)閉鎖及區(qū)間閉鎖3 個(gè)區(qū)域，如圖6 所示。當(dāng)車輛駛?cè)肴肓虚T限時(shí)，車輛進(jìn)入入列狀態(tài)。此狀態(tài)下，該車輛的控制權(quán)歸本地路口所有，本地分站同時(shí)向關(guān)聯(lián)路口分享該車輛位置數(shù)據(jù)。當(dāng)車輛繼續(xù)駛過(guò)關(guān)聯(lián)閉鎖門限時(shí)，車輛進(jìn)入關(guān)聯(lián)閉鎖狀態(tài)，此時(shí)關(guān)聯(lián)路口需要響應(yīng)以提前作出警示。當(dāng)車輛駛出區(qū)間閉鎖門限時(shí)，車輛進(jìn)入?yún)^(qū)間閉鎖狀態(tài)，駛向的關(guān)聯(lián)路口需要響應(yīng)以繼續(xù)作出警示，其余關(guān)聯(lián)路口恢復(fù)通行狀態(tài)。

2.2邏輯判定規(guī)則

邏輯判定的目是引導(dǎo)車輛在斜坡道安全行駛，以避免產(chǎn)生交通問(wèn)題。本文結(jié)合斜坡道運(yùn)輸?shù)膶?shí)際情況對(duì)邏輯判定規(guī)則進(jìn)行了歸納，主要分為8 種情況：① 未入列狀態(tài)；② 入列限行；③ 關(guān)聯(lián)閉鎖；④ 區(qū)間閉鎖；⑤車輛飽和限行； ⑥ 特殊車輛跟車禁止；⑦ 輔助信號(hào)燈判定；⑧ 優(yōu)先放行。

1） 未入列狀態(tài)如圖7 所示。當(dāng)車輛駛向路口A 且未經(jīng)過(guò)入列門限時(shí)，若駛離的地方為車場(chǎng)、工作面或與路口A 不關(guān)聯(lián)的路口，則認(rèn)為車輛為未入列狀態(tài)，路口A 的燈1 為綠色狀態(tài)。

2） 當(dāng)車輛駛過(guò)入列門限后，進(jìn)入路口A 的控制區(qū)域。此時(shí)車輛位置狀態(tài)切換為入列限行狀態(tài)（圖8），路口A 的燈1 應(yīng)變?yōu)榧t色。

3） 當(dāng)車輛駛過(guò)路口A 的關(guān)聯(lián)閉鎖門限后，車輛切換為關(guān)聯(lián)閉鎖狀態(tài)（圖9） ，本地路口A 的燈1 釋放，恢復(fù)成綠燈狀態(tài)。路口B、C 與路口A 關(guān)聯(lián)，當(dāng)路口B、C 的分站從路口A 的分站處讀到有非關(guān)聯(lián)車輛（即不在關(guān)聯(lián)閉鎖區(qū)內(nèi)的車輛）駛?cè)腙P(guān)聯(lián)閉鎖門限時(shí)，路口B、C 的關(guān)聯(lián)燈（燈1）變?yōu)榧t色響應(yīng)狀態(tài)，以警示路口內(nèi)司機(jī)：關(guān)聯(lián)路口可能有車駛向本路口。

4） 當(dāng)車輛駛出路口A 并經(jīng)過(guò)區(qū)間閉鎖門限后，車輛切換為區(qū)間閉鎖狀態(tài)（圖10）。路口B 的分站未檢測(cè)到路口A 有非關(guān)聯(lián)的關(guān)聯(lián)閉鎖車及關(guān)聯(lián)的區(qū)間閉鎖車，因此路口B 的燈1 恢復(fù)為綠色；而路口C 的分站讀到與路口A 的閉鎖區(qū)有區(qū)間閉鎖車輛，路口C 的燈1 保持紅色。當(dāng)車輛行駛到路口C 的入列門限后，車輛位置狀態(tài)重新進(jìn)入入列限行狀態(tài)，開始新的循環(huán)。

5） 車輛飽和限行包括閉鎖區(qū)車輛超限限行和路口飽和限行。閉鎖區(qū)車輛超限限行如圖11（a）所示，當(dāng)同時(shí)有3 輛車（閉鎖區(qū)限行3 輛）駛?cè)肼房贏 與路口B 之間的閉鎖區(qū)時(shí)，路口A 的燈1 會(huì)變紅，限制車輛繼續(xù)進(jìn)入閉鎖區(qū)，以免造成擁堵。路口飽和限行如圖11（b）所示，當(dāng)路口A 出現(xiàn)≤1 個(gè)岔口能放行車輛的情況時(shí)，除最先有車的關(guān)聯(lián)路口的關(guān)聯(lián)燈（路口B 的燈1）為綠燈外，其余關(guān)聯(lián)路口的關(guān)聯(lián)燈（路口C、D 的燈1）均為紅燈，以免造成擁堵。

6） 特殊車輛跟車限行是指炸藥運(yùn)輸車、油罐車等駛?cè)腴]鎖區(qū)間時(shí)，該閉鎖區(qū)關(guān)聯(lián)的信號(hào)燈會(huì)變紅，禁止后續(xù)車輛跟車。

7） 當(dāng)井下環(huán)境不好、斜坡道過(guò)窄或視線受阻時(shí)，可能存在司機(jī)開車過(guò)程中看不到對(duì)應(yīng)閉鎖區(qū)信號(hào)燈的問(wèn)題，需要增加輔助信號(hào)燈。輔助信號(hào)燈按邏輯可分為2 種，一種是同步信號(hào)燈，一種是放行信號(hào)燈。同步信號(hào)燈與對(duì)應(yīng)關(guān)聯(lián)信號(hào)燈同步顯示，放行信號(hào)燈需要根據(jù)本地路口其他信號(hào)燈情況判定，一般遵循“有紅則紅”的原則。

同步信號(hào)燈如圖12（a）所示。由于視線受阻，區(qū)間②與區(qū)間③的司機(jī)互相看不到對(duì)方信號(hào)燈，此時(shí)可分別在區(qū)間②、③安裝對(duì)方的同步信號(hào)燈，以提醒區(qū)間內(nèi)的司機(jī)對(duì)向區(qū)間內(nèi)有來(lái)車。放行信號(hào)燈如圖12（b）所示。區(qū)間①、②為主巷道，區(qū)間②連接到停車場(chǎng)，可在停車場(chǎng)出口安裝放行信號(hào)燈，用于管控停車場(chǎng)內(nèi)車輛的駛離。當(dāng)主巷道有來(lái)車時(shí)，放行信號(hào)燈變紅，禁止車輛駛離，讓主巷道車輛先行，以免發(fā)生“頂牛”。

8） 優(yōu)先放行車輛包括優(yōu)先放行閉鎖區(qū)車輛和特殊車輛，二者邏輯相似。當(dāng)優(yōu)先放行閉鎖區(qū)有車或一般閉鎖區(qū)有特殊車輛時(shí)，除該閉鎖區(qū)外的關(guān)聯(lián)信號(hào)燈都變紅，以確保其余閉鎖區(qū)沒有車輛進(jìn)入，保證車輛享有優(yōu)先通行權(quán)。

3改進(jìn)卡爾曼濾波算法

3.1問(wèn)題分析

為降低施工和維修難度，提高便攜性，本文使用的車輛定位卡為無(wú)源定位卡，受低功耗設(shè)計(jì)限制，定位卡位置更新頻率約為0.5 s/次，這就造成信號(hào)燈響應(yīng)延時(shí)問(wèn)題。舉例，如圖13 所示，T 時(shí)刻車輛位置臨近門限位置，車輛位置狀態(tài)未發(fā)生變化，此時(shí)系統(tǒng)不會(huì)進(jìn)行邏輯切換，直到下一采樣時(shí)刻T'，車輛已駛離門限位置較長(zhǎng)一段距離，此時(shí)系統(tǒng)才會(huì)進(jìn)行響應(yīng)，這就造成信號(hào)燈響應(yīng)延時(shí)，繼而影響關(guān)聯(lián)路口的及時(shí)響應(yīng)。

此外，受本身動(dòng)態(tài)精度降低及外在環(huán)境等因素的影響，UWB 定位數(shù)據(jù)存在動(dòng)態(tài)誤差大、數(shù)據(jù)失真和間斷性數(shù)據(jù)丟失等問(wèn)題，通過(guò)卡爾曼濾波算法可以有效改善這些問(wèn)題[20-21]。但在實(shí)際運(yùn)算過(guò)程中，在非線性條件下，如在臨時(shí)下客、車輛啟動(dòng)或者路障減速等車輛加/減速的情況下，卡爾曼濾波后的數(shù)據(jù)與實(shí)際數(shù)值偏差較大。為提高信號(hào)燈閉鎖控制的可靠性、及時(shí)性和UWB 動(dòng)態(tài)定位精度，本文對(duì)卡爾曼濾波算法進(jìn)行改進(jìn)，提出一種強(qiáng)跟蹤卡爾曼濾波算法。

4狀態(tài)觀測(cè)器

采用基于結(jié)果分析的狀態(tài)觀測(cè)器驗(yàn)證閉鎖控制算法性能。狀態(tài)觀測(cè)器布置于上位機(jī)內(nèi)，通過(guò)以太網(wǎng)TCP 協(xié)議與井下各定位分站通信，獲取路口各信號(hào)燈狀態(tài)、車輛實(shí)時(shí)行駛位置信息與算法過(guò)程數(shù)據(jù)等。狀態(tài)觀測(cè)器工作流程如下：

1） 車輛行駛到路口B 時(shí)，狀態(tài)觀測(cè)器采集到進(jìn)入車輛的位置數(shù)據(jù)，并記錄該車輛定位卡號(hào)。

2） 狀態(tài)觀測(cè)器采集關(guān)聯(lián)路口信號(hào)燈狀態(tài)信息，緩存采樣周期內(nèi)井下各岔路口帶時(shí)間戳的信號(hào)燈狀態(tài)信息。本文設(shè)置采樣時(shí)間間隔為1 s，采樣周期為15 s。

3） 車輛行駛到路口B 的相鄰路口A 或C 時(shí)，狀態(tài)觀測(cè)器再次采集到該車輛信息。

4） 獲取當(dāng)前時(shí)間前關(guān)聯(lián)路口信號(hào)燈狀態(tài)信息。

5） 將通過(guò)車輛閉鎖邏輯關(guān)系判斷的信號(hào)燈狀態(tài)與采集的信號(hào)燈狀態(tài)進(jìn)行對(duì)比，若一致則判定信號(hào)控制閉鎖成功，否則為閉鎖失敗。

6） 讀取并保存強(qiáng)跟蹤卡爾曼濾波算法過(guò)程數(shù)據(jù)，用于算法濾波效果的追蹤反饋和參數(shù)調(diào)整。

5仿真與工業(yè)現(xiàn)場(chǎng)驗(yàn)證

5.1仿真分析

根據(jù)工業(yè)現(xiàn)場(chǎng)數(shù)據(jù)進(jìn)行仿真模擬，模擬車輛以6 m/s 的初速度進(jìn)入路口，在第27 s 時(shí)以?0.6 m/s² 的加速度行駛，在路口中心停留40 s 后，以0.6 m/s² 的加速度駛離路口。測(cè)量噪聲按速度大小線性增加且符合正態(tài)分布，噪聲均值為0，車輛靜止時(shí)噪聲誤差標(biāo)準(zhǔn)差為0.1 m，車輛速度為6 m/s 時(shí)噪聲誤差標(biāo)準(zhǔn)差為0.3 m。采用常見的加權(quán)遞推平均濾波算法、卡爾曼濾波算法與強(qiáng)跟蹤卡爾曼濾波算法進(jìn)行對(duì)比分析。

5.1.1定位性能

UWB 定位模塊測(cè)得的車輛距離濾波前后對(duì)比如圖14 所示。可看出4 種情況下的距離幾乎一致。將測(cè)得的距離減去模擬時(shí)的給定值，得到測(cè)距誤差，如圖15所示。

當(dāng)車輛以6 m/s 速度穩(wěn)定運(yùn)行時(shí)，經(jīng)過(guò)加權(quán)遞推平均濾波后的誤差（均方根平均值）不降反增，這是因?yàn)槠骄涤?jì)算導(dǎo)致數(shù)據(jù)滯后；而經(jīng)過(guò)卡爾曼濾波后的誤差由30.62 cm 降到20.18 cm， 精度提高34.09%； 經(jīng)過(guò)強(qiáng)跟蹤卡爾曼濾波后的誤差降到22.76 cm，精度提高25.67%。當(dāng)車輛靜止時(shí)，經(jīng)過(guò)加權(quán)遞推平均濾波后的誤差由10.04 cm 降到10.28 cm，精度提高7.57%； 經(jīng)過(guò)卡爾曼濾波后的誤差降到7.10 cm，精度提高29.28%；經(jīng)過(guò)強(qiáng)跟蹤卡爾曼濾波后的誤差降到7.31 cm，精度提高27.19%。與加權(quán)遞推平均濾波相比，卡爾曼濾波在動(dòng)態(tài)濾波方面優(yōu)勢(shì)較大，雖然強(qiáng)跟蹤卡爾曼濾波精度不如卡爾曼濾波，但當(dāng)車輛減速或加速時(shí)，強(qiáng)跟蹤卡爾曼濾波適應(yīng)能力更強(qiáng)。

5.1.2速度跟蹤性

能車輛速度濾波前后對(duì)比如圖16 所示。當(dāng)車輛以6 m/s 速度穩(wěn)定運(yùn)行時(shí)，經(jīng)過(guò)加權(quán)遞推平均濾波后的速度誤差由16.81 cm/s 降到14.33 cm/s，精度提高14.74%；經(jīng)卡爾曼濾波后速度誤差降到11.64 cm/s，精度提高30.75%；經(jīng)過(guò)強(qiáng)跟蹤卡爾曼濾波后的速度誤差降到12.56 cm/s，精度提高25.28%。當(dāng)車輛靜止時(shí)，經(jīng)加權(quán)遞推平均濾波后速度誤差由10.94 cm/s 降到8.71 cm/s，精度提高20.38%；經(jīng)過(guò)卡爾曼濾波后的速度誤差降到6.65 cm/s，精度提高39.21%；經(jīng)過(guò)強(qiáng)跟蹤卡爾曼濾波后的速度誤差降到7.14 cm/s，精度提高34.73%。由圖16 中放大部分可知，當(dāng)車速變動(dòng)時(shí)，強(qiáng)跟蹤卡爾曼濾波響應(yīng)更快。

5.2工業(yè)現(xiàn)場(chǎng)驗(yàn)證

在西部礦業(yè)錫鐵山分公司斜坡道進(jìn)行了工業(yè)性試驗(yàn)。西部礦業(yè)錫鐵山分公司運(yùn)輸斜坡道全長(zhǎng)10 km，建有31 個(gè)錯(cuò)車路口，5 個(gè)三岔口。本次工業(yè)性試驗(yàn)共安裝定位分站36 臺(tái)，信號(hào)燈78 臺(tái)，其余硬件主要包括上位機(jī)、地面核心交換機(jī)、環(huán)網(wǎng)接入器、不間斷電源箱及車輛定位卡等，如圖17 所示。

5.2.1位置及速度濾波數(shù)據(jù)分析

狀態(tài)觀測(cè)器記錄的工業(yè)現(xiàn)場(chǎng)數(shù)據(jù)如圖18 所示，可看出現(xiàn)場(chǎng)試驗(yàn)結(jié)果與仿真結(jié)果基本相符。

狀態(tài)觀測(cè)器記錄的車輛經(jīng)過(guò)門限的預(yù)測(cè)時(shí)間及前后采樣時(shí)間對(duì)比見表1，采樣時(shí)間間隔為500 ms。當(dāng)前一時(shí)刻采樣結(jié)束后，系統(tǒng)通過(guò)算法預(yù)測(cè)到車輛經(jīng)過(guò)門限的時(shí)間，并在對(duì)應(yīng)時(shí)間點(diǎn)切換邏輯做出響應(yīng)，不用等到后一時(shí)刻采樣的時(shí)間點(diǎn)，這極大提高了信號(hào)燈閉鎖控制的準(zhǔn)確性與及時(shí)性。其中，第4 組數(shù)據(jù)的前后時(shí)刻間隔為1 029 ms，表明系統(tǒng)采樣時(shí)丟失中間1 幀數(shù)據(jù)，通過(guò)預(yù)測(cè)時(shí)間可有效解決采樣失敗后的控制延時(shí)問(wèn)題。

5.2.2信號(hào)燈閉鎖效果分析

為了進(jìn)一步驗(yàn)證優(yōu)化后的結(jié)果，通過(guò)遠(yuǎn)程狀態(tài)觀測(cè)器獲取信號(hào)燈控制狀態(tài)，統(tǒng)計(jì)井下30 d 內(nèi)的信號(hào)燈閉鎖次數(shù)及閉鎖成功次數(shù)，結(jié)果見表2。

濾波前后信號(hào)燈閉鎖成功率對(duì)比如圖19 所示，可看出算法改進(jìn)后的閉鎖成功率達(dá)99.5% 以上，遠(yuǎn)高于卡爾曼濾波算法。同時(shí)，狀態(tài)觀察器的數(shù)據(jù)分析可為井下分站故障診斷、數(shù)據(jù)優(yōu)化迭代提供數(shù)據(jù)支撐。

6結(jié)論

1） 分析了基于UWB 的井下車輛定位原理，提出了適合非煤礦山井下特點(diǎn)的信號(hào)燈邏輯判定方法。

2） 針對(duì)UWB 動(dòng)態(tài)定位精度不足及車輛定位數(shù)據(jù)丟失等問(wèn)題，提出一種強(qiáng)跟蹤卡爾曼濾波算法，通過(guò)強(qiáng)跟蹤自適應(yīng)方式計(jì)算預(yù)測(cè)誤差，提高定位精度，通過(guò)準(zhǔn)確預(yù)測(cè)車輛到達(dá)門限的時(shí)間，使斜坡道系統(tǒng)信號(hào)燈門限邏輯判定響應(yīng)更快，閉鎖成功率更高。

3） 采用遠(yuǎn)程狀態(tài)觀測(cè)器評(píng)估信號(hào)燈閉鎖控制效果，基于時(shí)域自動(dòng)跟蹤的統(tǒng)計(jì)，實(shí)現(xiàn)了閉鎖可靠性的量化評(píng)估，為井下分站故障診斷、數(shù)據(jù)優(yōu)化迭代提供數(shù)據(jù)支撐。

4） 仿真結(jié)果表明，改進(jìn)卡爾曼濾波算法后，車輛動(dòng)態(tài)與靜態(tài)位置誤差分別降低25.67% 和27.19%，動(dòng)態(tài)與靜態(tài)速度誤差分別降低25.28% 和34.73%，信號(hào)燈門限邏輯響應(yīng)更快。井下工業(yè)性試驗(yàn)和應(yīng)用結(jié)果表明，采用強(qiáng)跟蹤爾曼濾算法后，井下信號(hào)閉鎖成功率達(dá)99.5% 以上，有效提高了井下斜坡道岔路口信號(hào)閉鎖控制的可靠性，保障了井下車輛行駛安全。