基于UWB技術的定位算法設計

黃佳鑫，王民慧

（貴州大學 電氣工程學院，貴陽 550025）

0 引 言

隨著科技的高速發(fā)展，各類定位技術手段層出不窮，但有些方法在不同條件下會受到不同的影響。例如衛(wèi)星信號，這種信號在室內(nèi)會受到嚴重影響，從而導致GPS或是北斗無法發(fā)送定位。因此，室內(nèi)定位主要采用無線通訊、基站定位、慣導定位等多種技術集成，形成一套室內(nèi)位置定位體系，從而實現(xiàn)人員、物體等在室內(nèi)空間中的位置監(jiān)控。除通訊網(wǎng)絡的蜂窩定位技術外，常見的室內(nèi)無線定位技術還有：Wi-Fi、藍牙、紅外線、超寬帶、RFID、ZigBee和超聲波等。近年來，由于超帶寬（UWB）技術的成熟，被廣泛應用于各個領域，如移動機器人定位，煤礦人員定位等［1］。2019年9月，蘋果的iPhone11系列的創(chuàng)新之一是首發(fā)了UWB技術，用于精準的室內(nèi)定位和導航。此外，恩智浦也推出了UWB芯片。今后UWB在汽車、智能家居、工業(yè)等將會有更加廣泛的應用。

多年前UWB僅僅是一種通信協(xié)議，著重于高速數(shù)據(jù)的短距離傳輸。經(jīng)過十多年的發(fā)展，相對于Wi-Fi定位、藍牙定位等其它現(xiàn)有技術，UWB具有穿透力強、功耗低、抗多徑效果好、安全性高、系統(tǒng)復雜度低、能提供精確定位精度等優(yōu)勢。除此之外，UWB技術解決了困擾傳統(tǒng)無線通信技術多年的有關傳播方面的重大難題，具有對信道衰落不敏感、發(fā)射信號功率譜密度低、截獲率低、系統(tǒng)復雜度低、能提供數(shù)厘米的定位精度等優(yōu)點。

在智能家居逐漸進入人們生活的同時，市場對于UWB定位技術的需求也隨之增加。在日常智能生活使用中，可以通過UWB，擁有某個人的精準定位信息，能夠更加個性化地控制智能家居的功能。例如戴兒童手表的孩子，走丟時可以給父母打電話，在短距離的情況下通過手機或手表內(nèi)的UWB，精準定位小孩的位置［2］。

UWB技術提供精確、安全、實時的定位功能，主要針對的是人員與設備之間，這是其它無線技術（如Wi-Fi、藍牙和GPS）無法比擬的。其最大的優(yōu)勢在于它是基于到達時間差原理進行定位。不同于場強原理，因此抗干擾及多徑能力更強，不存在累計誤差、偏差小、精度更高，可廣泛應用于消防搶險、物流跟蹤、機器人、監(jiān)獄管理、醫(yī)療設備管控、可穿戴設備等。

本設計是基于STM32單片機為主控芯片，通過DW1000芯片進行數(shù)據(jù)傳輸，利用TWR原理，通過時間差算出標簽與基站之間的距離［3］。利用三邊測量算法，在固定好基站坐標的情況下，求得標簽坐標，達到定位效果。

1 系統(tǒng)設計

本設計主要由傳感器模塊、控制器與處理器模塊、顯示模塊和數(shù)據(jù)接收模塊等構成。系統(tǒng)以STM32F407ZGT6單片機作為主控核心控制器，通過傳感器模塊對距離等數(shù)據(jù)信息進行采集，然后傳給STM32F407ZGT6單片機，數(shù)據(jù)處理轉(zhuǎn)換后，在顯示模塊上顯示標簽實時數(shù)據(jù)信息。

該設計實現(xiàn)了對標簽數(shù)據(jù)信息的實時監(jiān)測，同時實現(xiàn)數(shù)據(jù)可視化，讓使用者可以清晰明了的掌握所需信息，為使用者提供更大的便利。

系統(tǒng)包括：數(shù)據(jù)接收、數(shù)據(jù)處理、數(shù)據(jù)顯示3個關鍵部分。系統(tǒng)總體框架如圖1所示。

圖1 系統(tǒng)總體框架Fig.1 System overall design drawing

1.1 硬件設計

硬件系統(tǒng)以STM32F407ZGT6單片機作為主控核心控制器，STM32F103RCT6單片機作為從控數(shù)據(jù)接收控制器。利用DWM1000傳感器模塊采集標簽與基站之間的數(shù)據(jù)后，將數(shù)據(jù)傳輸?shù)絊TM32F103RCT6單片機中，再通過串口通信方式，將STM32F103RCT6單片機上的數(shù)據(jù)傳輸?shù)絊TM32F407ZGT6單片機中。數(shù)據(jù)通過STM32F407ZGT6單片機收處理后，傳送到LCD顯示模塊進行數(shù)據(jù)顯示。系統(tǒng)方案如圖2所示。

圖2 系統(tǒng)方案設計框圖Fig.2 Block diagram of system scheme design

1.1.1 DWM1000傳感器

DWM1000模塊是基于Decawave公司DW1000芯片設計的超寬帶收發(fā)模組。該模塊集成了天線及所有的射頻電路、電源管理和時鐘電路［4］。這款模塊可用于TWR或TDOA定位系統(tǒng)中，用來定位目標，其精度一般小于10cm；且該模塊支持高達6.8Mbps的數(shù)據(jù)傳輸率。

DWM1000板上的DW1000芯片，是基于CMOS的、低功耗的無線收發(fā)集成電路，遵循802.15.4-2011協(xié)議中的UWB標準芯片［5］。DWM1000并不需要用戶設計電路，因為模塊上包含了天線、無線通訊模塊及相關的電路。

DWM1000模塊中嵌入了一個38.4 MHZ參考晶振，可以把初始化頻率誤差降到大約百萬分之二［6］。DWM1000電路原理如圖3所示。

圖3 DWM1000電路原理圖Fig.3 DWM1000 circuit schematic

1.1.2 LCD屏幕設計

LCD（Liquid Crystal Display）俗稱液晶顯示屏，屬于平面顯示器的一種，用于電視機及計算機的屏幕顯示。該顯示屏的優(yōu)點是耗電量低、體積小、輻射低。TFT型的液晶顯示器較為復雜，主要由熒光管、導光板、偏光板、濾光板、玻璃基板、配向膜、液晶材料、薄模式晶體管等構成。液晶顯示器必須先利用背光源，也就是熒光燈管投射出光源，這些光源先經(jīng)過一個偏光板后再經(jīng)過液晶，這時液晶分子的排列方式進而改變穿透液晶的光線角度。之后這些光線接還必須經(jīng)過前方的彩色濾光膜與另一塊偏光板［7］。因此，只要改變刺激液晶的電壓值就可以控制最后出現(xiàn)的光線強度與色彩，進而使液晶面板上變化出不同深淺的顏色組合。LCD屏幕原理如圖4所示。

圖4 LCD屏幕原理圖Fig.4 LCD screen schematic

1.2 定位算法設計

利用P1、P2、P3作為基站，對標簽N進行定位。假定基站為P1（x1，y1，z1），P2（x2，y2，z2），P3（x3，y3，z3），標簽為N（x，y，z），S1為N與P1之間距離；S2為N與P2之間距離；S3為N與P3之間距離［8］。如圖5所示。

圖5 位置圖Fig.5 Location Map

1.3 軟件設計

三邊定位系統(tǒng)的主程序流程如圖6所示。首先系統(tǒng)分別進行時鐘初始化、中斷分組配置、串口初始化、LED初始化、LCD初始化以及按鍵等初始化，將各個部分初始為最佳狀態(tài)；通過DWM1000得到各個基站位置坐標（x1，y1）、（x2，y2）、（x3，y3），以及標簽與各基站相距位移S1、S2、S3。通過這些數(shù)據(jù)，判斷基站是否處于同一條直線或者相距位置是否過近。根據(jù)三點確定一個平面的原則，若基站處于同一直線上，則無法進行坐標確定。如果基站相對位置過于貼近，會由于誤差的影響導致測量坐標不準確。因此，無論哪種情況出現(xiàn)都需要重新調(diào)整基站位置再進行實驗。STM32F407ZGT6單片機接收到傳來的數(shù)據(jù)信息后，通過三邊定位算法，隨后對矩陣求解，計算出標簽最終坐標。標簽坐標求得后，通過STM32F407ZGT6單片機驅(qū)動LCD屏幕，在屏幕上對標簽位置坐標進行顯示［10］。與此同時DWM1000不斷測量數(shù)據(jù)傳給STM32F407ZGT6單片機然后進行處理，隨后展示與LCD屏幕上，達到實時效果［11］。

圖6 系統(tǒng)程序設計圖Fig.6 System programming diagram

2 實驗結果分析

本設計系統(tǒng)在學校實驗室進行，為便于使用與測量，3個基站設置成直角三角形。3個基站位置坐標分別為（0，0）、（2.4，0）、（0，3.0）。將標簽與STM32F407ZGT6單片機連接，分別將3個基站與標簽同時上電。連接成功后將程序燒錄于主控芯片之中，此時可以在LCD屏幕上看到位置信息。實驗顯示的實際坐標、測量坐標位置及坐標誤差值見表1。

表1 實驗結果對比Tab.1 Comparison of experimental results

由此可見，實際誤差基本在9 cm以內(nèi)，部分點誤差在10 cm以內(nèi)。由于實驗過程中標簽與基站之間偶爾會出現(xiàn)遮擋物，則造成一定測量誤差。

3 結束語

本設計實現(xiàn)了對標簽數(shù)據(jù)信息的實時監(jiān)測，同時實現(xiàn)數(shù)據(jù)可視化，讓使用者可以清晰明了的掌握所需信息，為使用者提供更大的便利。但在測試過程中也發(fā)現(xiàn)些許不足，傳感器處于工作狀態(tài)時，組成測量區(qū)域內(nèi)有金屬等干擾源及過多障礙物出現(xiàn)，會對測量結果產(chǎn)生一定影響。所以，為盡量降低干擾，提高測量準確率，安裝基站時一般應高于標簽所處水平面位置。除此之外，后期應優(yōu)化算法，軟硬件配合共同提高使用精度。