林 俊，廖 平

LIN Jun, LIAO Ping

（中南大學(xué) 高性能復(fù)雜制造國家重點實驗室，長沙 410083）

0 引言

工程機械是現(xiàn)代裝備制造業(yè)的重要組成部分，是為國民經(jīng)濟建設(shè)提供技術(shù)裝備的支柱產(chǎn)業(yè)，對國家經(jīng)濟建設(shè)、現(xiàn)代工業(yè)化水平的提高以及產(chǎn)業(yè)結(jié)構(gòu)戰(zhàn)略規(guī)劃等方面起著至關(guān)重要的作用[1,2]。隨著國家工業(yè)化進程的加快，工程機械大規(guī)模使用，而且作業(yè)范圍不斷擴大，這無疑增加了工程機械的監(jiān)控管理難度，因此研究和開發(fā)出一種能夠準確確定工程機械的地理位置且能遠程進行監(jiān)控的定位監(jiān)控系統(tǒng)具有十分重要的意義。

北斗衛(wèi)星導(dǎo)航系統(tǒng)（以下簡稱北斗系統(tǒng)）是中國著眼于國家安全和經(jīng)濟社會發(fā)展需要，自主建設(shè)、獨立運行的衛(wèi)星導(dǎo)航系統(tǒng)，現(xiàn)已逐步開始對民用市場開放。北斗系統(tǒng)具有短報文通信功能，使得工程機械在作業(yè)環(huán)境惡劣、通信不佳的情況下仍可保持通信，這為搶險救災(zāi)帶來極大的便利。考慮到北斗系統(tǒng)現(xiàn)階段服務(wù)區(qū)域的限制，本文就上述問題，提出了一種基于北斗/GPS雙模定位的工程機械車載定位監(jiān)控系統(tǒng)設(shè)計方案，既能滿足工程機械高精度定位導(dǎo)航的需求，又能提供北斗系統(tǒng)與GPS系統(tǒng)的競爭力，有助于推動國家北斗衛(wèi)星導(dǎo)航產(chǎn)業(yè)化的發(fā)展[3～7]。

1 定位數(shù)學(xué)模型

1.1 北斗單系統(tǒng)數(shù)學(xué)模型

采用偽距法分析北斗單系統(tǒng)定位[8,9]，接收端除了接收觀測點三個空間坐標分量（x，y，z）外，還有接收端的時鐘差，一共有4個未知量，因此，為了求解這4個未知量，需要4顆或4顆以上衛(wèi)星的偽距測量值，如圖1所示。

圖1 北斗衛(wèi)星定位原理

對4顆衛(wèi)星進行偽距測量得到如下方程組：

為求解方程組(1)，本文采用線性化的迭代方法進行求解。假設(shè)接收機的近似位置已知，則真實位置（x，y，z）可由近似位置和偏移量來表示，再加上時間偏差估計值則可得到單一近似偽距函數(shù)：

方程(2)的解可看作近似分量和增量分量兩部分組成，因此有：

對式(3)在近似點處用一階Taylor級數(shù)展開[10]并截去一階導(dǎo)數(shù)之后的項以消除非線性項，經(jīng)過線性化處理后單一偽距方程可表示為：

因此方程組(1)可表示為：

其中，

方程組(1)的解為：

當采用超過4顆衛(wèi)星來定位時，用最小二乘法[11]求解方程組，得到方程組(1)的解為：

1.2 雙系統(tǒng)聯(lián)合定位數(shù)學(xué)模型

同樣采用偽距法對北斗和GPS雙系統(tǒng)聯(lián)合定位進行分析。在雙系統(tǒng)聯(lián)合定位前，北斗系統(tǒng)和GPS系統(tǒng)的坐標基準和時間基準需要統(tǒng)一。由于北斗系統(tǒng)采用的CGCS2000坐標系和GPS采用的WGS-84坐標系都是協(xié)議地心直角坐標系，其坐標系的原點、尺度和定向都相同，且兩個坐標系的精度都達到了5cm，因此對于工程機械的定位而言，兩個坐標系可看作同一個坐標系，不需要進行坐標系間的轉(zhuǎn)換。北斗的時間系統(tǒng)和GPS的時間系統(tǒng)采用的時間基準不一致，而組合定位算法是在單系統(tǒng)各自獨立定位的基礎(chǔ)上擴展而來，定位原理相似，因此通過增加狀態(tài)變量把各自衛(wèi)星定位系統(tǒng)的接收模塊時鐘差當做未知量一起求解，從而使得組合定位系統(tǒng)的時間統(tǒng)一?；谏鲜鲈恚诒倍穯蜗到y(tǒng)的基礎(chǔ)上增加接收模塊相對GPS的時鐘差未知量，如北斗單系統(tǒng)一樣建立偽距方程組，通過線性迭代的方法將方程組線性化，再采用最小二乘法求解方程組中的5個未知量，因此，采用雙系統(tǒng)聯(lián)合定位時觀測的衛(wèi)星數(shù)量必須大于等于5顆。

2 定位監(jiān)控系統(tǒng)總體設(shè)計

本文設(shè)計的工程機械車載定位監(jiān)控系統(tǒng)主要由核心處理單元、LCD人機交互界面、定位模塊和4G無線通信模塊組成，如圖2所示。其中定位模塊采集工程機械的地理位置、航向、速度等信息；核心處理單元對定位模塊采集的信息進行存儲處理，并傳輸至LCD人機交互界面顯示；4G無線通信模塊則通過UDP網(wǎng)絡(luò)協(xié)議將工程機械的地理位置等信息上傳至遠程服務(wù)器，實現(xiàn)對工程機械的遠程監(jiān)控。

圖2 車載定位監(jiān)控系統(tǒng)總體框圖

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

系統(tǒng)總體框圖如圖3所示，本定位監(jiān)控系統(tǒng)硬件電路采用“核心板+功能板”方案進行設(shè)計，核心板電路包含了i.MX6Q核心處理器、2G DDR3內(nèi)存、8G eMMC存儲單元等，實現(xiàn)對整個系統(tǒng)的控制、數(shù)據(jù)處理存儲等功能；功能板電路由供電模塊、定位模塊、LCD顯示、4G無線通信模塊等組成，分別用來實現(xiàn)系統(tǒng)各個子功能。

3.1 核心板

圖3 定位系統(tǒng)硬件電路結(jié)構(gòu)框圖

本文的核心板設(shè)計采用工業(yè)級汽車處理器i.MX6Q系列高性能處理器，是基于ARM Cortex-A9內(nèi)核的處理器，擁有四個核心，主頻高達1GHz，內(nèi)部集成UART、I2C、SPI、PCIe等諸多外設(shè)，還自帶圖形加速、音視頻編解碼等功能，性能強悍，同時支持Linux系統(tǒng)和Android系統(tǒng)，既能滿足當前定位系統(tǒng)的功能需求，又便于后期的系統(tǒng)功能擴展和升級。核心板上還擴展了2G DDR3內(nèi)存和8G eMMC存儲單元以保證系統(tǒng)高效穩(wěn)定運行和數(shù)據(jù)的存儲。

3.2 定位模塊

本文的定位模塊采用中科微電子的ATGM336H-5N搭建外圍電路來實現(xiàn)，如圖4所示。引腳11外接GPS天線增強接收衛(wèi)星信號的強度，引腳4發(fā)出秒脈沖，外接發(fā)光二極管D2，正常工作時發(fā)光二極管以脈沖頻率閃爍，便于確定定位模塊是否正常工作運行。引腳6外接后備電池，同時提供3.3V電源以保證定位模塊得以熱啟動。定位模塊可以與處理器通過I2C或者UART進行通訊，因本系統(tǒng)采用間接數(shù)據(jù)存儲方式，故采用UART與處理器通訊，通過引腳2發(fā)送數(shù)據(jù)給處理器，引腳3接收處理器發(fā)送的數(shù)據(jù)。

3.3 4G無線通信模塊

無線通信模塊是本地和監(jiān)控中心進行通信的核心，綜合考慮當今的網(wǎng)絡(luò)通信環(huán)境、傳輸速率以及成本，本文最終采用美芯訊科技有限公司的SIM7100C4G模塊作為無線數(shù)據(jù)傳輸通信模塊。

3.4 LCD顯示模塊

本系統(tǒng)要求能夠本地顯示當前地理位置信息，考慮到工程機械的工作環(huán)境比較惡劣，因此本文采用7寸TFT高清電容觸摸屏，分辨率1024×600，既能清晰地顯示所需信息，也能有效地增強抗干擾能力。

3.5 供電電源模塊

本系統(tǒng)主要需要12V、5V、3.3V三種電源，其中12V為外部接入電源，5V主要用于LCD供電，3.3V用于給處理器、4G模塊、定位模塊等功耗相對較低的部分供電。

圖4 定位電路

5V電源和3.3V電源都是由12V電源利用降壓芯片MP1495DJ獲得，輸出電壓與輸出電路中的兩個電阻參數(shù)有關(guān)，其計算公式為：

圖5 電源電路

以5V電源電路為例，圖5即為5V穩(wěn)壓電路的實現(xiàn)原理圖。要獲得3.3V電壓只需更改R1和R2的參數(shù)，將圖5中R2所標識的電阻阻值由7.5K改為12.7K即可。

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

本文的系統(tǒng)需要接收ATGM336H-5N雙模定位模塊的衛(wèi)星數(shù)據(jù)信息，對接收的數(shù)據(jù)包進行解析獲得需要的有效數(shù)據(jù)，并在LCD上顯示定位信息及電子地圖信息，同時需要向監(jiān)控中心上傳地理位置信息。為滿足軟件系統(tǒng)的交互性、穩(wěn)定性等需求，本文采用“Linux+Qt”的方式實現(xiàn)定位系統(tǒng)軟件[12]，軟件系統(tǒng)整體由底層軟件和上層應(yīng)用軟件組成。底層軟件包括u-boot-2015.04的移植、kernel-4.1.15移植以及Qt根文件系統(tǒng)搭建，上層應(yīng)用軟件則主要由定位部分和4G無線數(shù)據(jù)傳輸部分構(gòu)成。

4.1 定位部分軟件設(shè)計

4.1.1 定位模塊數(shù)據(jù)輸出協(xié)議簡介

ATGM336H-5N雙模定位模塊輸出數(shù)據(jù)協(xié)議整體兼容國際標準NMEA0183協(xié)議，數(shù)據(jù)格式協(xié)議框架如表1所示。

由于ATGM336H-5N模塊支持北斗/GPS雙模定位，因此輸出數(shù)據(jù)還包含了特殊的協(xié)議幀[13,14]：兩條地址符相同的$GNGSV協(xié)議幀，數(shù)據(jù)量會隨著北斗定位衛(wèi)星信號強度變化而發(fā)生改變的$BDGSV協(xié)議幀。

4.1.2 定位模塊輸出數(shù)據(jù)解析

ATGM336H-5N模塊輸出的數(shù)據(jù)有一定的特點，每個數(shù)據(jù)包都包含以下協(xié)議幀：

$GPTXT、$GNGGA、$GNGLL、$GPGSA、$BDGSA、多條$GPGSV、2條$BDGSV、$GNRMC、$GNVTG和$GNZDA，以上協(xié)議幀的輸出格式都遵循圖4所示的數(shù)據(jù)格式協(xié)議框架。ATGM336H-5N模塊輸出數(shù)據(jù)的解析包含了下面四個關(guān)鍵基本步驟：數(shù)據(jù)包的分割、協(xié)議幀的識別、協(xié)議幀的分割、協(xié)議幀的信息解讀[15]。本文數(shù)據(jù)解析都是基于上述四個基本步驟加上協(xié)議幀糾錯完成解析的。由于ATGM336H-5N模塊連續(xù)不斷地通過串口發(fā)送數(shù)據(jù)，串口數(shù)據(jù)容易發(fā)生粘包，且MCU定時讀取串口數(shù)據(jù)，接收的數(shù)據(jù)可能不完整，因而無法直接使用接收的數(shù)據(jù)，而且數(shù)據(jù)量也比較大，因此在解析ATGM336H-5N模塊的輸出數(shù)據(jù)時增加了處理機制，盡量保存完整的數(shù)據(jù)，接收并處理數(shù)據(jù)的過程如圖6所示。

圖6 數(shù)據(jù)處理流程

4.2 無線數(shù)據(jù)傳輸部分軟件設(shè)計

地理位置信息數(shù)據(jù)利用4G通信模塊采用UDP協(xié)議上傳至遠程服務(wù)器，數(shù)據(jù)傳輸流程如圖7所示。

圖7 數(shù)據(jù)無線傳輸流程

表1 數(shù)據(jù)格式協(xié)議框架

表2 24小時定位監(jiān)測數(shù)據(jù)

5 實驗驗證

為驗證文中監(jiān)控系統(tǒng)的穩(wěn)定性，從早上8:00至次日7:00每間隔一小時從監(jiān)控中心讀取定位數(shù)據(jù)信息，實驗結(jié)果如表2所示，結(jié)果表明文中的系統(tǒng)具有良好的穩(wěn)定性。文中的系統(tǒng)實時定位效果可以在LCD上顯示，顯示效果如圖8所示，達到了預(yù)期的要求。

圖8 實時定位效果

6 結(jié)語

本文設(shè)計的基于北斗/GPS的工程機械車載定位監(jiān)控系統(tǒng)，從硬件和軟件兩個方面進行設(shè)計開發(fā)，通過系統(tǒng)試驗驗證，不僅實現(xiàn)了工程機械的定位導(dǎo)航，還實現(xiàn)了對工程機械的遠程監(jiān)控，極大地方便了工程機械的管理，具有一定的實用性價值。