奚潤開，吳鍵，陳靈，王鑫

(南京理工大學(xué) 機械工程學(xué)院，江蘇 南京 210094)

0 引言

近年來，信息化、智能化的生活方式越來越受到關(guān)注，位置信息服務(wù)可以給人們生活帶來很大的便捷[1]。

應(yīng)用廣泛的GNSS全球?qū)Ш叫l(wèi)星系統(tǒng)[2]在遇到障礙物時會衰減或者散射，而且在遮擋較多的室內(nèi)環(huán)境下有很大的局限性，這也使得位置信息服務(wù)難以開展。室內(nèi)定位技術(shù)開展過程中會面臨許多難題。首先，室內(nèi)環(huán)境比較復(fù)雜，傳感器通常需要在非視距(NLOS)情況下完成測量任務(wù)，且墻壁等密集設(shè)施產(chǎn)生嚴(yán)重的多徑干擾，這使得測量數(shù)據(jù)準(zhǔn)確性大打折扣。其次，以TOA、TDOA[3]為主的基于時間測量定位系統(tǒng)對發(fā)射以及接收節(jié)點的時間同步要求極高，每1 ns的時鐘誤差會造成30cm定位誤差，這使得定位系統(tǒng)的成本大大提高。

為應(yīng)對室內(nèi)環(huán)境復(fù)雜多變、大量障礙物干擾的情況，本文對基于載波相位差[4-5]的室內(nèi)定位系統(tǒng)進行了研究與實現(xiàn)，借助433MHz載波信號較強的穿透能力與繞射能力，通過信號到達節(jié)點兩端接收天線相位差值的測量實現(xiàn)室內(nèi)多遮擋、非視距的復(fù)雜環(huán)境下的目標(biāo)定位功能。與性能優(yōu)異的UWB室內(nèi)定位技術(shù)[6]相比，該系統(tǒng)不需要高精度的時間同步，且頻譜占用少、定位范圍廣，在非視距環(huán)境下，433MHz的載波信號有著較強的繞射以及穿透能力，與傳統(tǒng)的WiFi、Bluetooth等定位技術(shù)[7-8]相比有著更高的定位精度。

1 定位原理

圖1給出了載波相位差定位系統(tǒng)在二維平面內(nèi)某一節(jié)點的接收天線與信號源的關(guān)系。在A、B兩個觀測點上的接收天線與定位目標(biāo)C的距離分別為d1、d2，兩個觀測點的間距為d3。載波信號由位于目標(biāo)位置的全向天線發(fā)出，兩個接收天線與信號處理模塊組成一個負(fù)責(zé)檢測載波相位差的傳感器節(jié)點。

圖1 定位目標(biāo)與接收機的幾何關(guān)系

在室內(nèi)平面坐標(biāo)系中，假設(shè)目標(biāo)C的天線幾何中心的坐標(biāo)為(x,y)，x和y都為待測量，觀測點A、B的天線幾何中心的坐標(biāo)分別為(xA,yA)和(xB,yB)，它們都為已知量。目標(biāo)與觀測點間距表達式為

(1)

d1和d2的差值可以用未知量x和y表示。同時，該距離差值可以雙天線結(jié)構(gòu)的傳感器節(jié)點進行測量。

假設(shè)節(jié)點接收天線A、B在某時間點的載波信號的相位為φA與φB，它們可以表示為

(2)

式中：RA與RB分別表示信號源到接收天線A、B的距離；λ表示載波信號的波長；δtr和δts分別表示傳感器節(jié)點的時鐘誤差以及信號源的時鐘誤差；NA和NB表示天線A、B接收到的載波信號整周模糊度；εlA和εlB分別表示接收天線A、B與信號處理模塊之間的硬件電路對信號相位產(chǎn)生的偏差；εnA和εnB為載波相位測量時由于測量噪聲產(chǎn)生的相位偏差。硬件電路對相位的影響可以采用精密匹配的信號接收電路消除，使εlA和εlB的差值可以忽略不計。

在雙接收天線信號傳輸電路精密匹配的情況下，相位差ΔφA,B可以表示為

(3)

為了方便分析，將式(3)兩端對2π取余。由于NA和NB都為整數(shù)，取余后可以消除，而測量噪聲對相位值的影響εnA和εnB遠小于一個周期，取余后可以將其保留。結(jié)果可以表示為

(4)

(5)

由式(5)可知，忽略測量噪聲的影響，最終相位差檢測值位于(-π,π)之間。通常情況下，相位差檢測電路難以判斷信號到達的先后順序，所以最終的檢測結(jié)果一般為正值，其范圍為(0,π)。

綜上所述，在理想情況下，該雙天線結(jié)構(gòu)傳感器節(jié)點的相位差測量值可以表征室內(nèi)坐標(biāo)系內(nèi)任意一點的距離差絕對值信息即目標(biāo)所在的雙曲線。

2 定位算法

本文室內(nèi)定位系統(tǒng)的距離差方程可以表示為以下形式：

R2i-1,2i=R2i-R2i-1=

(6)

式中：i為觀測點編號；n為觀測點組數(shù)即傳感器節(jié)點的數(shù)量。

現(xiàn)將式(6)在(x0,y0)處一階泰勒級數(shù)展開，可得

R2i-1,2i=R2i-R2i-1+

(7)

根據(jù)式(7)得出其殘差Ψ的矩陣表示：

ψ=H-Gδ

(8)

式中δ、H、G為：

(9)

采用最小二乘算法計算δ的最小二乘估計：

δ=(GTG)-1GTH

(10)

經(jīng)過上述步驟，待修正坐標(biāo)的估值為

(11)

最后判斷(|Δx|+|Δy|)是否達到預(yù)期的閾值，若不滿足要求，用修正坐標(biāo)繼續(xù)進行最小二乘迭代，直到滿足閾值要求。

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

系統(tǒng)的總體設(shè)計方案如圖2所示。定位系統(tǒng)主要由信號源模塊、傳感器節(jié)點、基站節(jié)點等組成。

圖2 定位系統(tǒng)總體方案設(shè)計

圖2中信號源模塊負(fù)責(zé)433 MHz正弦波信號的產(chǎn)生與發(fā)送，主要由stm32主控芯片、鎖相頻率合成芯片、環(huán)路濾波器、電源和天線組成。頻率合成器選擇某公司的ADF4351產(chǎn)品。ADF4351有簡易的SPI接口，可用于數(shù)字信號控制。本文選擇使用stm32F103C8T6控制芯片[9]。環(huán)路濾波器采用典型的三階環(huán)路濾波。信號源模塊結(jié)構(gòu)如圖3所示。

圖3 信號源結(jié)構(gòu)

無線傳感網(wǎng)絡(luò)中的傳感器節(jié)點在室內(nèi)定位系統(tǒng)中負(fù)責(zé)利用雙天線采集目標(biāo)發(fā)出的433 MHz信號，并利用無線模塊將數(shù)據(jù)上傳。傳感器節(jié)點主要由兩根433 MHz高增益天線、AC耦合電路、相位差檢測電路、STM32主控模塊以及CC2630無線通信模塊組成。其結(jié)構(gòu)框圖如圖4所示。

圖4 傳感器節(jié)點結(jié)構(gòu)

基站節(jié)點由路由器(Router)和協(xié)調(diào)器(Coordinator)節(jié)點組成?；竟?jié)點選擇采用兩片CC2630芯片搭建。IEEE802.15.4標(biāo)準(zhǔn)協(xié)議嵌入在片內(nèi)ROM中，在ARM-Cortex-M0處理器上單獨運行，能夠獨立進行網(wǎng)絡(luò)的組織以及數(shù)據(jù)的收發(fā)。CC2630的Cortex-M3內(nèi)核負(fù)責(zé)邏輯處理，主要包括與主控芯片的串口通信。STM32F103RCT6主控芯片主要負(fù)責(zé)接收處理無線模塊的數(shù)據(jù)，上傳至上位機。基站節(jié)點的結(jié)構(gòu)框圖如圖5所示。

圖5 基站節(jié)點結(jié)構(gòu)

4 定位算法仿真結(jié)果分析

本章節(jié)利用MATLAB2017b對基于先驗坐標(biāo)與泰勒級數(shù)展開的最小二乘迭代算法進行仿真。

此次仿真的定位范圍為9m×6m的矩形空間，設(shè)置6個傳感器節(jié)點，節(jié)點坐標(biāo)如表1所示。選擇9個測試點模擬定位目標(biāo)(信號源)。傳感器節(jié)點中心在圖中用黑色實心正方形表示，測試點用黑色實心三角形表示。

在仿真過程中給載波相位測量值疊加0%～5%波長的隨機測量噪聲。對每個點分別進行20次定位運算，其中由直線排列的傳感器節(jié)點組測量的先驗坐標(biāo)使用紅色小點表示，定位算法的結(jié)果使用綠色小點表示。最終的仿真結(jié)果如圖6所示。仿真結(jié)果的最大誤差與算法迭代次數(shù)如表2所示(本刊黑白印刷，相關(guān)疑問請咨詢作者)。

表1 傳感器節(jié)點坐標(biāo) 單位：m

圖6 MATLAB仿真圖像

表2 MATLAB仿真結(jié)果 單位：m

根據(jù)仿真結(jié)果可得：

1)定位算法的仿真結(jié)果最大誤差均<0.5m。由3個傳感器節(jié)點協(xié)作獲得先驗坐標(biāo)的最大誤差超過1m，最大達到1.167m。因此可證明本算法的參數(shù)估計定位結(jié)果有著較高的可靠性。

2)定位算法保證收斂，最多只需要5次迭代就可以達到預(yù)先設(shè)置的1×10-5m的閾值，有著較低的時間復(fù)雜度，可以高效地完成位置解算任務(wù)。

5 定位實驗結(jié)果分析

選擇一個8.42m×9.7m的矩形區(qū)域進行室內(nèi)定位實驗。實驗環(huán)境如圖7所示。

圖7 定位實驗環(huán)境

定位實驗區(qū)域節(jié)點以及相關(guān)設(shè)施擺放如圖8所示。

圖8 定位實驗節(jié)點布置

其中各個傳感器節(jié)點及其兩個接收天線在室內(nèi)平面坐標(biāo)系中的坐標(biāo)如表3所示，定位實驗結(jié)果如表4所示。

表3 定位實驗接收天線坐標(biāo) 單位：m

表4 定位實驗結(jié)果 單位：m

由定位實驗結(jié)果可得：

1)本文定位系統(tǒng)在80m2的定位區(qū)域內(nèi)，受到室內(nèi)木制隔板的遮擋，平均定位誤差可以控制在0.6m以內(nèi)，最大定位誤差不超過1.6m。定位結(jié)果證明了本文定位方法的可行性。傳統(tǒng)室內(nèi)定位方法例如藍牙、WiFi定位在非視距環(huán)境下的定位誤差在3m左右，本文的室內(nèi)定位系統(tǒng)與之相比在非視距環(huán)境下有著更好的定位精度。

2)對于本文的定位系統(tǒng)，由于室內(nèi)環(huán)境多徑干擾嚴(yán)重，當(dāng)信號源靠近墻壁等障礙物時，載波信號受到較大干擾，影響相位差測量精度，例如測試點3與測試點4有著0.43m的定位精度差距。同樣，接收天線附近的墻壁等也會很大程度影響載波相位差測量精度。

3)本文使用的泰勒級數(shù)展開最小二乘迭代算法適用于本文的基于載波相位差的室內(nèi)定位系統(tǒng)，在保證收斂性的同時可以通過少于6次的最小二乘迭代算法完成參數(shù)估計。