袁婷

（深圳市金溢科技股份有限公司，廣州 510665)

0 引言

在高速公路ETC定位系統(tǒng)[2]中，天線安裝高度在5米左右，天線的安裝方式是吊裝，安裝角度只有俯仰角。相比于高速ETC定位，停車(chē)場(chǎng)的天線設(shè)備安裝比較低，安裝方式大多采用側(cè)裝，天線安裝角度參數(shù)不僅有俯仰角還有方位角，尤其方位角安裝精度不容易控制。為了對(duì)安裝天線角度不精確的誤差進(jìn)行糾正，提出一種在軟件上校準(zhǔn)天線安裝水平角（本文稱為方位角）角度的方法。

1 OBU坐標(biāo)定位算法實(shí)現(xiàn)

按照天線的輻射方向建立坐標(biāo)系x_ant、y_ant，由新一代相控陣天線得到關(guān)于坐標(biāo)系x_ant、y_ant的OBU俯仰角和方位角，設(shè)定在坐標(biāo)系x_ant、y_ant的第一象限，方位角為正值，第二象限的方位角為負(fù)值。由坐標(biāo)計(jì)算算法得到坐標(biāo)系x_ant、y_ant下面的OBU坐標(biāo)，通過(guò)向量點(diǎn)積的運(yùn)算，轉(zhuǎn)換到坐標(biāo)系X、Y平面的OBU 坐標(biāo)。設(shè)（x0，y0）為在坐標(biāo)系 x_ant、y_ant下面的OBU坐標(biāo)（即設(shè)定天線是吊裝情況下的OBU坐標(biāo)）。

坐標(biāo)系X、Y平面的OBU坐標(biāo)，有：

其中θ0是天線安裝的方位角，φ0是天線安裝的俯仰角，（Ux,Uy）是校準(zhǔn)點(diǎn)一在平面坐標(biāo)系的坐標(biāo)，h是OBU相對(duì)地面的高度，H是天線安裝的高度。

2 校準(zhǔn)點(diǎn)算法

校準(zhǔn)算法通過(guò)在車(chē)道設(shè)立校準(zhǔn)點(diǎn)，對(duì)天線安裝角度不精確導(dǎo)致的定位誤差進(jìn)行軟件上糾正。本文設(shè)立兩個(gè)校準(zhǔn)點(diǎn)，按照車(chē)道布局建立坐標(biāo)系X、Y、Z，如圖1所示，得到兩個(gè)校準(zhǔn)點(diǎn)在車(chē)道X、Y、Z平面的位置U（Ux,Uy,Uz）、W（Wx,Wy，Wz）。以天線投射點(diǎn)和天線支架所在平面為天線投射平面S，從天線設(shè)備到投射點(diǎn)的連線為天線投射線L0，從天線設(shè)備到校準(zhǔn)點(diǎn)的連線為L(zhǎng)1。從校準(zhǔn)點(diǎn)做與投射平面正交的平面S1，S與S1的交線L01與L0的夾角為此校準(zhǔn)點(diǎn)的俯仰角φ，L1與L01的夾角為校準(zhǔn)點(diǎn)的方位角θ。

由校準(zhǔn)點(diǎn)的坐標(biāo)，天線的安裝方位角、俯仰角、高度和OBU的高度，計(jì)算校準(zhǔn)點(diǎn)方位角和俯仰角的理論值。以校準(zhǔn)點(diǎn)一為例計(jì)算：

俯仰角φ=arctan（（Uxsinθ0+Uycosθ0）/（H-h））-φ0。

方位角θ =arctan（-（Ux cosθ0-Uy sinθ0）·cos（φ0+φ）/（H-h））。

圖1

2.1 校準(zhǔn)兩個(gè)點(diǎn)

（1）設(shè)校準(zhǔn)點(diǎn)一的坐標(biāo)為（x1,y1），由上述公式可得校準(zhǔn)點(diǎn)一的方位角θ1和俯仰角φ1的理論值。

（2）將OBU置于第一個(gè)校準(zhǔn)點(diǎn)的位置，由相控陣天線獲取OBU第一幀回復(fù)信號(hào)（VST），根據(jù)VST中的定位信息，通過(guò)一定計(jì)算可得：

OBU所在位置的方位角測(cè)量值（dx）和俯仰角測(cè)量值（dy），x1_meas_angel和 y1_meas_angel。

（3）校準(zhǔn)點(diǎn)一方位角補(bǔ)償中間值：方位角理論值-測(cè)量值（x1_offset_angel=-（x1_meas_angel-θ1））。

校準(zhǔn)點(diǎn)一俯仰角補(bǔ)償值：俯仰角理論值-測(cè)量值（y1_offset_angel=-（y11_meas_angel-φ1））。

（4）同理，可得校準(zhǔn)點(diǎn)二的方位角θ2和俯仰角φ2的理論值。

方位角補(bǔ)償中間值：X2_offset_angel=-（x2_meas_angel-θ2）。

同時(shí)，試驗(yàn)數(shù)據(jù)的線性相關(guān)性用線性相關(guān)系數(shù)R大小來(lái)判斷，該值在-1～1范圍內(nèi)。當(dāng)|R|越接近1線性質(zhì)量越好。線性相關(guān)系數(shù)R的計(jì)算公式為：

x2_meas_angel和y2_meas_angel分別是校準(zhǔn)點(diǎn)二的方位角和俯仰角50次測(cè)量值的平均值。

2.2 天線角度軟件補(bǔ)償

兩個(gè)點(diǎn)均校準(zhǔn)完畢，軟件自動(dòng)計(jì)算得到天線方位角的校準(zhǔn)值，對(duì)天線配置的安裝角度與實(shí)際的安裝角度之間的偏差進(jìn)行糾正，計(jì)算公式如下：

天線方位角補(bǔ)償值：校準(zhǔn)點(diǎn)一和校準(zhǔn)點(diǎn)二的方位角補(bǔ)償中間值的平均值（angle_θ0_offset=（X1_off?set_angel+X2_offset_angel）/2）。

補(bǔ)償后的天線方位角：天線方位角初始值+天線方位角補(bǔ)償值（angle_θ0=θ0+angle_θ0_offset）。

俯仰角補(bǔ)償值：Y2_offset_angel=-（y2_meas_an?gel-φ2）。

2.3 校準(zhǔn)點(diǎn)角度補(bǔ)償

在對(duì)天線方位角進(jìn)行校準(zhǔn)補(bǔ)償之后，再對(duì)校準(zhǔn)點(diǎn)一和校準(zhǔn)點(diǎn)二的方位角進(jìn)行補(bǔ)償，使其在天線方位角已經(jīng)校準(zhǔn)的基礎(chǔ)上，對(duì)OBU所在位置的測(cè)量方位角再次進(jìn)行補(bǔ)償，使在交易過(guò)程中，測(cè)量得到的OBU方位角經(jīng)過(guò)補(bǔ)償后，更接近于實(shí)際OBU所在坐標(biāo)的方位角，從而使計(jì)算的坐標(biāo)更接近實(shí)際坐標(biāo)。具體補(bǔ)償方式如下：

校準(zhǔn)點(diǎn)一的方位角補(bǔ)償值：校準(zhǔn)點(diǎn)一的方位角理論值-（校準(zhǔn)點(diǎn)一的方位角測(cè)量值+天線方位角補(bǔ)償值）（X1_offset_angel=θ1-（x1_meas_angel+angle_θ0_offset））。

校準(zhǔn)點(diǎn)二的方位角補(bǔ)償值：校準(zhǔn)點(diǎn)二的方位角理論值-（校準(zhǔn)點(diǎn)二的方位角測(cè)量值+天線方位角補(bǔ)償值）（x2_offset_angel=θ1-（x2_meas_angel+angle_θ0_offset））。

圖2 校準(zhǔn)流程

3 交易過(guò)程校準(zhǔn)補(bǔ)償

對(duì)天線方位角和校準(zhǔn)點(diǎn)校準(zhǔn)補(bǔ)償之后，根據(jù)這兩個(gè)校準(zhǔn)點(diǎn)將車(chē)道劃分為3個(gè)區(qū)域，區(qū)域按照方位角劃分，OBU的測(cè)量方位角大于校準(zhǔn)點(diǎn)一的方位角的區(qū)域（θ>θ1）屬于1區(qū)，小于校準(zhǔn)點(diǎn)一的方位角且大于校準(zhǔn)點(diǎn)二的方位角的區(qū)域（θ2<θ<θ1）屬于2區(qū)，小于校準(zhǔn)點(diǎn)二的方位角的區(qū)域（θ<θ2）屬于3區(qū)，如圖3所示。1區(qū)補(bǔ)償?shù)姆轿唤呛透┭鼋鞘牵▁1_offset_angel，y1_offset_an?gel），3區(qū)補(bǔ)償?shù)姆轿唤呛透┭鼋鞘牵▁2_offset_angel，y2_offset_angel），2區(qū)的補(bǔ)償是在1區(qū)和3區(qū)之間，根據(jù)OBU的方位角變化進(jìn)行線性補(bǔ)償，補(bǔ)償值為（x_offset，y_offset），計(jì)算公式如下：

x_offset=（θ- θ1）*（x1_offset_angel-x2_offset_angel）/（θ1-θ2）+x1_offset_angel;

y_offset=（θ-θ1）*（x1_offset_angel-x2_offset_angel）/（θ1-θ2）+x1_offset_angel;

圖3 校準(zhǔn)分區(qū)

上位機(jī)發(fā)送校準(zhǔn)信號(hào)時(shí)，設(shè)備進(jìn)入校準(zhǔn)模式，對(duì)天線方位角和兩個(gè)校準(zhǔn)點(diǎn)進(jìn)行校準(zhǔn)補(bǔ)償，并將校準(zhǔn)值保存在校準(zhǔn)文件中。退出校準(zhǔn)模式后，進(jìn)入交易模式，天線設(shè)備發(fā)送BST，OBU收到BST后回復(fù)VST，天線根據(jù)VST中的角度矩陣信息計(jì)算得到OBU的方位角和俯仰角，軟件自動(dòng)根據(jù)OBU方位角的值初步判斷OBU所在的區(qū)域，根相應(yīng)區(qū)域進(jìn)行角度補(bǔ)償，包括方位角和俯仰角，再計(jì)算得到OBU的實(shí)際坐標(biāo)。得到OBU坐標(biāo)之后，再進(jìn)行坐標(biāo)區(qū)域限制判斷。例如本道區(qū)域限定設(shè)為X是（0,2.5），Y是（0,6），將坐標(biāo)限制在這個(gè)區(qū)域，在區(qū)域范圍內(nèi)的允許往下交易（獲取OBU信息、卡片信息、消費(fèi)等），不在區(qū)域范圍的不容許往下交易，如圖6流程圖所示，從而解決旁道和跟車(chē)干擾[1]。

4 結(jié)語(yǔ)

本文給出了基于停車(chē)場(chǎng)ETC的定位算法，以及對(duì)天線安裝的誤差在軟件上進(jìn)行校準(zhǔn)補(bǔ)償?shù)乃惴?。此算法已?jīng)在實(shí)際場(chǎng)景中應(yīng)用，定位精度很有優(yōu)勢(shì)。