連續(xù)超聲波位置跟蹤器的設(shè)計(jì)原理及其在虛擬現(xiàn)實(shí)系統(tǒng)中的應(yīng)用實(shí)現(xiàn)
位置跟蹤器是虛擬現(xiàn)實(shí)和其它人機(jī)實(shí)時(shí)交互系統(tǒng)中最重要的輸入設(shè)備之一,它實(shí)時(shí)地測(cè)量用戶身體或其局部的位置和方向并作為用戶的輸入信息傳遞給虛擬現(xiàn)實(shí)系統(tǒng)的主控計(jì)算機(jī),從而根據(jù)用戶當(dāng)前的視點(diǎn)信息刷新虛擬場(chǎng)景的顯示.基于連續(xù)調(diào)幅超聲波相位差相干測(cè)距方法實(shí)現(xiàn)快速、高分辨率的動(dòng)/靜態(tài)方法測(cè)量的原理,本文著重闡述了以連續(xù)超聲波相位差相干測(cè)量法實(shí)現(xiàn)三維動(dòng)態(tài)位置測(cè)量的原理、系統(tǒng)設(shè)計(jì)、實(shí)驗(yàn)結(jié)果,并利用上述跟蹤器研究了具有三維實(shí)時(shí)交互控制能力的虛擬現(xiàn)實(shí)系統(tǒng)樣機(jī).
關(guān)鍵詞:位置跟蹤器;超聲波測(cè)距器;虛擬現(xiàn)實(shí)系統(tǒng);虛擬場(chǎng)景
Design of Position Tracker Using Continuous Ultrasonic Wave and Its Application in Virtual Reality
HUA Hong,WANG Yong-tian,CHANG Hong
(Dept.of Opto-Electronics Engineering,Beijing Institute of Technology,P.O.Box 327,Beijing 100081,China)
Abstract:Position tracker is one of the most critical input devices for human-machine interface utilities in virtual reality and other human-machine interaction systems.It determines the position and orientation of an object of interest (such as the user's head) and passes the information to the host computer in real time,which redraws the virtual world on the basis of the current visual point of the user.A dynamic position tracker based on continuous amplitude-modulated ultrasonic wave is developed by means of the interferometric techniques.Its principles,technical implementation and experimental results are discussed.A prototype virtual reality system using the ultrasonic position tracker as an input device is also constructed and presented in the paper.
Key words:position tracker;ultrasonic rangefinder;virtual reality system;virtual world
一、引 言
靈境技術(shù),又稱“虛擬現(xiàn)實(shí)”(Virtual Reality,簡稱VR),是80年代在美國等科技先進(jìn)國家發(fā)展起來的一項(xiàng)新技術(shù),是以浸沒感、交互性和構(gòu)想為基本特征的高級(jí)人機(jī)界面,它綜合計(jì)算機(jī)仿真技術(shù)、圖像處理與模式識(shí)別技術(shù)、智能接口技術(shù)、人工智能技術(shù)、多媒體技術(shù)、計(jì)算機(jī)網(wǎng)絡(luò)技術(shù)、并行處理技術(shù)和多傳感器等電子技術(shù)模擬人的視覺、聽覺、觸覺等感官功能,使人能夠沉浸在計(jì)算機(jī)創(chuàng)造的虛擬場(chǎng)景中,并能夠通過多種感官渠道與虛擬世界的多維化信息環(huán)境進(jìn)行實(shí)時(shí)交互[1].
從廣義上講,虛擬現(xiàn)實(shí)系統(tǒng)由虛擬場(chǎng)景發(fā)生器、輸入設(shè)備和輸出設(shè)備組成.用于VR系統(tǒng)的輸入設(shè)備分為兩大類:交互設(shè)備和方位跟蹤設(shè)備.交互設(shè)備使得用戶在虛擬境界中漫游時(shí)能操縱虛擬物體,而方位跟蹤設(shè)備可以實(shí)時(shí)地測(cè)量并跟蹤用戶身體或其局部的物理位置和方向,使得他能夠在虛擬境界中漫游[1].由此可見方位跟蹤設(shè)備是創(chuàng)建虛擬現(xiàn)實(shí)系統(tǒng)的硬件基礎(chǔ).
在VR技術(shù)中,目前有機(jī)電式、電磁式、聲學(xué)式、光電式和慣性式五種常用的方位跟蹤器[2],其中以Polhemus Inc.和Asension Technology Corporation兩家公司的電磁跟蹤器和Logitech公司的超聲波跟蹤器最為著名,但這些產(chǎn)品不僅價(jià)格昂貴,而且存在著一些明顯不足之處.例如電磁跟蹤器對(duì)應(yīng)用環(huán)境的電磁特性有苛刻的要求.Logitech的超聲波跟蹤器克服了電磁跟蹤器的上述缺點(diǎn),但它采用的T.O.F(Time of Flight)方法[3]雖然具有原理簡單、易于實(shí)現(xiàn)的優(yōu)點(diǎn),但方位刷新頻率受到脈沖傳播時(shí)間的限制,在有六個(gè)測(cè)量通道、2m測(cè)量范圍的條件下,方位刷新頻率僅為二十幾Hz,這樣的刷新頻率不能滿足虛擬現(xiàn)實(shí)頭盔顯示器系統(tǒng)中對(duì)方位跟蹤器的要求,另外,多通道的距離數(shù)據(jù)非同步獲取,在目標(biāo)連續(xù)運(yùn)動(dòng)的情況下,必然給測(cè)量結(jié)果帶來較大誤差[4,5].
為了克服T.O.F方法的缺點(diǎn),本文利用連續(xù)超聲波相位差測(cè)距原理實(shí)現(xiàn)多通道同步測(cè)量,刷新頻率不再受聲波傳播時(shí)間的制約,多通道測(cè)量結(jié)果是同步相干數(shù)據(jù),能夠?qū)崿F(xiàn)快速、高分辨率的動(dòng)/靜態(tài)方位測(cè)量.再結(jié)合聲學(xué)式跟蹤器具有干擾源少、測(cè)量精度較高以及研制成本低等突出優(yōu)點(diǎn),因而在虛擬現(xiàn)實(shí)系統(tǒng)(如頭盔顯示器、數(shù)據(jù)手套)、機(jī)器人技術(shù)、武器系統(tǒng)、人機(jī)交互設(shè)備(如3D鼠標(biāo))等領(lǐng)域具有廣泛的應(yīng)用前景.
二、跟蹤器原理
1.位置測(cè)量原理
根據(jù)剛體動(dòng)力學(xué)的分析[6],能夠用運(yùn)動(dòng)物體上參考點(diǎn)的坐標(biāo)表示該物體的位置坐標(biāo),并通過測(cè)量該參考點(diǎn)到空間三個(gè)靜止的非共線點(diǎn)之間的距離唯一確定.
設(shè)在靜止參考坐標(biāo)系Cξηζ中,T是運(yùn)動(dòng)物體上的參考點(diǎn),其位置坐標(biāo)用T(Tξ,Tη,Tζ)表示,R1、R2和R3是分布在邊長為2a的等邊三角形頂點(diǎn)處的三個(gè)非共線固定點(diǎn),它們與參考坐標(biāo)系的關(guān)系如圖1所示,等邊三角形的重心與原點(diǎn)C重合,三角形所在平面與Cζ軸垂直,CR1與Cη軸重合,R2R3與Cξ軸平行,它們的空間坐標(biāo)依次為R1(0,2a/3,0)、R2(-a,-a/3,0)和R3(a,-a/3,0).
圖1 參考點(diǎn)的分布示意圖 設(shè)點(diǎn)T到R1、R2和R3三點(diǎn)的距離分別為L1、L2和L3,如圖1所示,則可列出以下方程組: (1) 求得T的位置坐標(biāo)為: (2) 由此可以推知,當(dāng)在T點(diǎn)固定超聲波發(fā)射器,在R1、R2和R3處分別固定超聲波接收器,根據(jù)發(fā)射信號(hào)與接收信號(hào)之間的相位關(guān)系分別測(cè)量三個(gè)接收器和發(fā)射器之間的距離[7,8],將測(cè)量所得到的距離和接收器的分布參數(shù)代入式(2)即可求出發(fā)射器的三維位置坐標(biāo),即運(yùn)動(dòng)物體的位置坐標(biāo).由于超聲波測(cè)距系統(tǒng)的快速響應(yīng)特征,通過一定采樣頻率的連續(xù)測(cè)量即可實(shí)現(xiàn)運(yùn)動(dòng)物體位置坐標(biāo)的快速動(dòng)態(tài)測(cè)量. (3) 3.測(cè)距原理 L1=NMv/f1 (7) 但由于音頻調(diào)制信號(hào)的頻率較低,相位差ΔΦM的測(cè)量精度受到數(shù)字鑒相器分辨力和其它信號(hào)處理電路分辨力的限制,導(dǎo)致L的分辨力受到限制.為此,在保證L1的分辨率高于超聲載波波長λc的前提下,從接收到的AM調(diào)制信號(hào)中提取載波信號(hào)RU,用數(shù)字鑒相器測(cè)量發(fā)射載波信號(hào)TU和接收載波信號(hào)RU之間的ΔΦC,數(shù)字鑒相器的插值頻率為f2,鑒相器的計(jì)數(shù)結(jié)果為NC,則距離L可以表示為: L=int(L1/λC)+NCv/f2 和傳統(tǒng)的連續(xù)超聲波相位差測(cè)距法相比較,上述連續(xù)調(diào)幅超聲波測(cè)距法不僅繼承了測(cè)量范圍大、刷新頻率高、測(cè)距精度高等優(yōu)點(diǎn),而且克服了處理電路復(fù)雜和需要粗測(cè)基準(zhǔn)的缺點(diǎn).它也不同于音頻測(cè)距法,不會(huì)受到環(huán)境聲音的干擾,也不會(huì)造成環(huán)境聲音污染. 三、跟蹤器設(shè)計(jì) |
圖2 發(fā)射器電路原理框圖 圖3 接收器電路原理框圖 數(shù)字鑒相器的工作波形如圖4所示. |
圖4 數(shù)字鑒相器的工作波形圖 至于該測(cè)距系統(tǒng)的電路設(shè)計(jì)、實(shí)驗(yàn)結(jié)果和性能分析請(qǐng)參考文獻(xiàn)[7]. 圖5 超聲波位置跟蹤器的原理框圖 四、實(shí)驗(yàn)結(jié)果與分析 |
圖6 測(cè)距結(jié)果與標(biāo)稱距離的比較 實(shí)驗(yàn)中使用發(fā)散角α=60°的換能器,測(cè)距單元的距離測(cè)量范圍為30cmL150cm,限定發(fā)射器最大測(cè)量高度滿足hmax120cm,要求坐標(biāo)分辨率滿足ΔTξ=ΔTη=ΔTζ1cm、誤差滿足eξ=eη=eζ1cm的條件下,接收器的分布邊長設(shè)計(jì)為2a=80cm,在此條件下,位置跟蹤器的坐標(biāo)測(cè)量范圍為(80cm,80cm,120cm). 表1 沿Cξ軸移動(dòng)時(shí)跟蹤器的基準(zhǔn)標(biāo)稱坐標(biāo)與測(cè)量坐標(biāo) |
次 數(shù) | 基準(zhǔn)標(biāo)稱坐標(biāo)(cm) | 測(cè)量坐標(biāo)(cm) | ||||
ξ | η | ζ | ξ | η | ζ | |
1 | -20 | 10 | 120 | -20.77 | 10.59 | 121.08 |
2 | -15 | 10 | 120 | -15.75 | 10.53 | 120.98 |
3 | -10 | 10 | 120 | -10.56 | 9.97 | 119.94 |
4 | -5 | 10 | 120 | -4.1 | 10.16 | 120.69 |
5 | 0 | 10 | 120 | 1.07 | 10.68 | 120.87 |
6 | 5 | 10 | 120 | 5.34 | 10.47 | 120.52 |
7 | 10 | 10 | 120 | 10.53 | 11.08 | 119.91 |
8 | 15 | 10 | 120 | 14.36 | 10.05 | 120.15 |
9 | 20 | 10 | 120 | 20.04 | 9.87 | 120.91 |
表2 沿Cη軸移動(dòng)時(shí)跟蹤器的基準(zhǔn)標(biāo)稱坐標(biāo)與測(cè)量坐標(biāo) |
次 數(shù) | 基準(zhǔn)標(biāo)稱坐標(biāo)(cm) | 測(cè)量坐標(biāo)(cm) | ||||
ξ | η | ζ | ξ | η | ζ | |
1 | 5 | -20 | 120 | 4.97 | -20.48 | 118.98 |
2 | 5 | -15 | 120 | 4.75 | -15.13 | 120.86 |
3 | 5 | -10 | 120 | 5.59 | -12.28 | 120.87 |
4 | 5 | -5 | 120 | 4.88 | -7.19 | 120.04 |
5 | 5 | 0 | 120 | 5.26 | -1.03 | 120.82 |
6 | 5 | 5 | 120 | 5.65 | 7.11 | 118.95 |
7 | 5 | 10 | 120 | 5.42 | 9.87 | 119.52 |
8 | 5 | 15 | 120 | 6.06 | 14.41 | 119.77 |
9 | 5 | 20 | 120 | 5.54 | 21.14 | 119.22 |
表3 沿Cζ軸移動(dòng)時(shí)跟蹤器的基準(zhǔn)標(biāo)稱坐標(biāo)與測(cè)量坐標(biāo) |
次 數(shù) | 基準(zhǔn)標(biāo)稱坐標(biāo)(cm) | 測(cè)量坐標(biāo)(cm) | ||||
ξ | η | ζ | ξ | η | ζ | |
1 | 10 | 10 | 85 | 8.89 | 9.92 | 85.25 |
2 | 10 | 10 | 90 | 9.25 | 10.56 | 90.82 |
3 | 10 | 10 | 95 | 8.75 | 10.58 | 96.06 |
4 | 10 | 10 | 100 | 9.06 | 11.16 | 101.12 |
5 | 10 | 10 | 105 | 9.58 | 10.45 | 106.08 |
6 | 10 | 10 | 110 | 9.33 | 11.57 | 110.85 |
7 | 10 | 10 | 115 | 9.62 | 11.08 | 116.2 |
8 | 10 | 10 | 120 | 8.87 | 9.04 | 120.5 |
五、應(yīng) 用 在以REND386開發(fā)的虛擬場(chǎng)景平臺(tái)上,用上述位置測(cè)量跟蹤系統(tǒng)作為一種方位跟蹤設(shè)備進(jìn)行用戶位置跟蹤,從而構(gòu)成了一個(gè)三維實(shí)時(shí)虛擬漫游系統(tǒng),其設(shè)計(jì)框圖如圖7所示,主要由三個(gè)超聲波測(cè)距單元、PC機(jī)數(shù)據(jù)采集單元、空間坐標(biāo)位置算法、虛擬場(chǎng)景生成程序和三自由度空間坐標(biāo)跟蹤器與虛擬場(chǎng)景發(fā)生器的接口驅(qū)動(dòng)程序構(gòu)成. |
圖7 三維實(shí)時(shí)虛擬現(xiàn)實(shí)漫游系統(tǒng)原理框圖 圖8(a)是虛擬場(chǎng)景的初始位置,圖8(b)是視點(diǎn)的相對(duì)位置坐標(biāo)從(0,0,0)變化到(50,20,50)時(shí)經(jīng)過刷新的場(chǎng)景圖像. |
圖8 (a)虛擬場(chǎng)景的(0,0,0)位置(b)虛擬場(chǎng)景的(50,20,50)位置 六、結(jié) 論 |
評(píng)論