作者/趙昌麗，天津中德應(yīng)用技術(shù)大學(xué)

基于GPS/BD組合定位方法的車輛軌跡連續(xù)性跟蹤系統(tǒng)

作者/趙昌麗，天津中德應(yīng)用技術(shù)大學(xué)

為保障專屬車道暢通，針對車道入侵監(jiān)測系統(tǒng)開發(fā)環(huán)節(jié)涉及的車輛軌跡連續(xù)性跟蹤問題，釆用了一種基于GPS/BD組合定位的方式以提高定位精度，在接收信號丟失時采用INS定位推算下一時刻位置，進(jìn)行了行人手持及車載低速情況下的測試工作，綜合定位精度達(dá)到0.6m以內(nèi)，能夠滿足系統(tǒng)整體監(jiān)測的需要，驗證了組合定位方法在車輛軌跡連續(xù)性跟蹤系統(tǒng)中應(yīng)用的可行性與有效性。

車道入侵；軌跡跟蹤；GPS/BD；INS

引言

針對車道入侵問題的探討[1]，多見于未來交通管理體系中的自主駕駛無人車輛的導(dǎo)航控制，以及當(dāng)前交通管理體系中對結(jié)構(gòu)化路面下車輛的車道歸屬規(guī)范，兩者所涉及的車道違規(guī)甚至非法占用，存在嚴(yán)重安全隱患，解決兩者問題的核心在于如何認(rèn)定車道是否存在入侵。

車道入侵于前者主要指車輛本體主動式的探測行為，以期約束車輛按既定軌跡完成規(guī)劃路線，而于后者主要涉及高速公路的應(yīng)急車道管理以及一般性城市結(jié)構(gòu)化路面近路口處的車道管制，為車輛本體外系統(tǒng)對車道的監(jiān)測行為。兩者的共性核心問題在于對車輛軌跡的實時準(zhǔn)確監(jiān)測，通常在該環(huán)節(jié)采用的單點GPS定位精度不高，而差分GPS在成本及面向移動作業(yè)時受到局限[2—4]。本文采用了GPS/BD雙單點定位方式，為解決該問題提供一種可行探討。

1. 系統(tǒng)總體設(shè)計

硬件系統(tǒng)模塊利用串口與其他模塊相連,該系統(tǒng)采用獨立化的模塊設(shè)計思路，各個模塊能夠獨立設(shè)計、獨立調(diào)試，互不影響，組成如圖1所示。當(dāng)衛(wèi)星信號良好，GPS/BD模塊負(fù)責(zé)提供衛(wèi)星定位信息，當(dāng)衛(wèi)星信號低于閾值時，由MPU6050模塊來提供慣導(dǎo)信息，定位信息由串口送至處理器模塊進(jìn)行信息處理后重新編制為符合GPRS協(xié)議的數(shù)據(jù)包，最后通過GPRS模塊被發(fā)送至監(jiān)控中心從而實現(xiàn)對車輛的定位[5,6]。

圖1 系統(tǒng)組成框圖

2. 定位相關(guān)系統(tǒng)硬件設(shè)計

定位系統(tǒng)模塊生產(chǎn)廠家很多，同一廠家型號也各有不同。例如U—blox公司，其就以生產(chǎn)的定位系統(tǒng)精度高，冷啟動速度快，用戶體驗好著稱，本系統(tǒng)采用的便是該公司生產(chǎn)的芯片。以定位為目的的芯片型號就有U—blox 6m、U—blox neo 7M、U—blox m8n等型號。本系統(tǒng)采用的是該公司最新生產(chǎn)的定位系統(tǒng)U—blox m8n，其兼具GPS和北斗兩種模式?？梢园凑沼脩糇约旱囊笈渲萌我环N模式。該模塊供電電壓為2.8V～6V，符合本系統(tǒng)5V的供電電壓。功耗為50mA，功耗水平低能夠增加本系統(tǒng)的續(xù)航時間。水平定位精度在2m之內(nèi)，輸出頻率為1Hz，基本滿足系統(tǒng)設(shè)計的各項指標(biāo)。本系統(tǒng)主要采用GPS/BD數(shù)據(jù)相融合的定位系統(tǒng)，提高了定位精度，彌補了單GPS或者單BD定位誤差大、數(shù)據(jù)易漂移的缺點，模塊如圖2所示。

圖2 定位模塊

系統(tǒng)主控制器采用STM32F系列32位ARM微控制器，其內(nèi)核是Cortex—M3。片內(nèi)Flash的大小為512K。芯片集成定時器，CAN，ADC，SPI，I2C，USB，UART，等多種功能。根據(jù)系統(tǒng)功耗低、體積小、電壓一致等的要求，本系統(tǒng)選擇了大唐聯(lián)芯LC5730型號的無線通信模塊。

3. 系統(tǒng)軟件設(shè)計

系統(tǒng)主要對車道數(shù)據(jù)進(jìn)行采集，通過網(wǎng)絡(luò)將采回的數(shù)據(jù)進(jìn)行上傳，終端上位機實時顯示車輛位置信息，系統(tǒng)框圖如圖3所示。第一步，主控芯片讀取GPS與BD的經(jīng)緯度坐標(biāo)。第二步，計算兩者經(jīng)緯度的距離差。第三步，判斷誤差范圍是否小于20cm，如果小于20cm，則對兩者進(jìn)行差分運算，得到較為精確的經(jīng)緯度坐標(biāo)，作為判斷車輛是否占用應(yīng)急車道的依據(jù)。如果經(jīng)緯度距離差大于20cm，而應(yīng)急車道的寬度為2.5m，通過計算得到，誤差比為16%，遠(yuǎn)低于系統(tǒng)設(shè)計要求的10%，說明兩者的經(jīng)緯度坐標(biāo)是不可信的，此時主控芯片讀取MPU6050的加速度、角度等狀態(tài)信息，以及GPS/BD上一時刻的經(jīng)緯度信息，推算出這一時刻車輛所在的經(jīng)緯度坐標(biāo)。第四步，判斷車輛是否進(jìn)入應(yīng)急車道，如果沒有進(jìn)入應(yīng)急車道則回到第一步繼續(xù)執(zhí)行，如果進(jìn)入應(yīng)急車道，記錄占用應(yīng)急車道的時長，超過10分鐘后，進(jìn)行聲光報警，并將占用時長、經(jīng)緯度坐標(biāo)等信息發(fā)送給遠(yuǎn)端上位機。

圖3 系統(tǒng)工作流程圖

4. 實驗驗證與分析

系統(tǒng)測試驗證主要通過手持系統(tǒng)測試與車載系統(tǒng)測試兩部分組成，手持狀態(tài)下從定點的誤差分析以及連續(xù)點的誤差分析兩方面測試主要目的有：

(1)驗證車輛連續(xù)性軌跡跟蹤的方案可行性；

(2)驗證連續(xù)性軌跡跟蹤的精度是否達(dá)到設(shè)計要求。

為了測試本系統(tǒng)室外手持連續(xù)軌跡跟蹤方案的可行性，由操作人員攜帶終端設(shè)備以1m/s的速度以“S”型曲線路線進(jìn)行運動，在此運動過程中，我們在每隔1m抽取1個點，按此方式執(zhí)行5次，行進(jìn)軌跡數(shù)據(jù)及對比如圖4所示。

圖4 手持測試數(shù)據(jù)對比及誤差

能夠看出，當(dāng)攜帶終端設(shè)備的人員按照基準(zhǔn)線行進(jìn)時，實際測量值是是在基準(zhǔn)線附近波動的，在前8m的范圍內(nèi)實際行走軌跡與設(shè)備獲取的數(shù)據(jù)軌跡之間的誤差范圍在0.6m之內(nèi)，連續(xù)性軌跡跟蹤能夠達(dá)到系統(tǒng)整體監(jiān)測的任務(wù)需求。

車載狀態(tài)下的系統(tǒng)測試，主要是驗證系統(tǒng)實際使用的可行性，模擬車輛在結(jié)構(gòu)化公路中的運行狀態(tài)，測試車輛運行過程中車輛軌跡跟蹤系統(tǒng)的方案可行性。

1.2.1 病房環(huán)境要求:干凈、安靜、舒適、安全。在各部門的檢查中,病房環(huán)境管理常常是不符合規(guī)范化要求。探討其中的原因如下:

車載測試選擇了1km距離的結(jié)構(gòu)化路段作為測試場所，由運行車輛攜帶終端設(shè)備以16m/s的速度以“S”型曲線路線進(jìn)行運動。移動端實時上傳采集的數(shù)據(jù)，上位機監(jiān)控軟件實時監(jiān)控車輛位置信息。在此運動過程中，我們在每隔100m抽取1個點，按此方式執(zhí)行4次，數(shù)據(jù)如圖5所示。

圖5 車載實驗數(shù)據(jù)及對比誤差

能夠看出，當(dāng)攜帶終端設(shè)備的車輛按照基準(zhǔn)線行駛時，實際測量值是是在基準(zhǔn)線附近波動的，在前50m的范圍內(nèi)實際運行軌跡與設(shè)備采集到的數(shù)據(jù)軌跡之間的誤差范圍在1m之內(nèi)，而在50m～70m之間，有小幅波動。

5. 結(jié)語

本文針對車道入侵問題，主要涉及車輛連續(xù)性軌跡的跟蹤問題開展了研究工作，對GPS/BD雙單點定位系統(tǒng)數(shù)據(jù)進(jìn)行了信息融合，在兩者定位給值偏差超出約定閾值的情況下，以來源于慣性測量組件的數(shù)據(jù)進(jìn)行推算估計予以校正，經(jīng)過行人手持及車載低速實驗，初步驗證了該組合定位方法的有效性及環(huán)境適用性，所設(shè)計的車輛軌跡連續(xù)性跟蹤系統(tǒng)整體表現(xiàn)良好。

＊ [1]劉超.城市車輛實時監(jiān)視系統(tǒng)的定位方法及信息傳輸技術(shù)研究[D].中國科學(xué)院研究生院(國家授時中心),2012.

隨著酒店業(yè)競爭加劇，酒店之間在客戶資源的爭搶上也愈發(fā)激烈，導(dǎo)致酒店的利潤空間不斷被壓縮。張瀟瀟（2103）指出必需將更加行之有效的信息化管理運用于酒店的管理中，對酒店的經(jīng)營空間進(jìn)行廣泛的開拓，實現(xiàn)運營成本的進(jìn)一步降低。其認(rèn)為酒店管理系統(tǒng)的合理運用，不僅可以對大量的信息進(jìn)行有效的管理，還可以將先進(jìn)的管理觀念引進(jìn)來，從而不斷地推動工作效率及服務(wù)質(zhì)量的提升，實現(xiàn)酒店內(nèi)部管理體制的不斷完善，提高酒店決策水平、經(jīng)濟效益以及關(guān)系效益，最終實現(xiàn)酒店競爭力的提升[9]。

＊ [2]何正斌.GPS/INS組合導(dǎo)航數(shù)據(jù)處理算法拓展研究[D].長安大學(xué),2012.

＊ [3]孟祥先.基于GPS和RFID技術(shù)的列車組合定位方案設(shè)計及數(shù)據(jù)處理方法研究[D].蘭州交通大學(xué),2014.

＊ [4]劉進(jìn)一,杜岳峰,張碩，等. 基于GNSS/MIMU/DR的農(nóng)業(yè)機械組合導(dǎo)航定位方法[J].農(nóng)業(yè)機械學(xué)報,2016.

＊ [5]林英杰,李東杰,梁光靜,等. 基于FPGA的快速車道偏離預(yù)警系統(tǒng)硬件實現(xiàn)[J].電子科技,2016.

＊ [6]汪亮,李子申,袁洪,周凱.BDS/GPS/GLONASS組合的雙頻單歷元相對定位性能對比分析[J]. 科學(xué)通報,2015.