楊 柳

(山西職業(yè)技術學院，山西 太原 030006)

基于慣性原理的頭部運動跟蹤系統(tǒng)的設計

楊 柳

(山西職業(yè)技術學院，山西 太原 030006)

在飛行模擬游戲中，需要頭部運動跟蹤系統(tǒng)采集解算人體頭部的動作，以模擬飛行員實際的視野移動。目前市售的頭部運動跟蹤系統(tǒng)采用了紅外跟蹤原理，本文主要研究了基于慣性原理的頭部運動跟蹤系統(tǒng)的工作原理和系統(tǒng)設計，本系統(tǒng)可適用于多種飛行模擬游戲。

頭部運動跟蹤；慣性原理；MPU6050；Arduino

飛行模擬游戲是利用計算機技術模擬真實飛行器飛行特性和操作過程，此類游戲起源較早，并具有較高的模擬程度和帶入感。玩家在飛行模擬游戲中扮演飛行員的角色，所以對外接設備要求很高，常用外設包括飛行控制器、節(jié)流閥、方向舵等。

在實際飛行中，為保證飛行安全，飛行員對視野范圍要求較高，飛行器在設計過程中會考慮飛行員對視野的要求。但在飛行模擬游戲中，玩家的視野被面積有限的顯示器限制，常規(guī)解決措施是安裝頭部運動跟蹤系統(tǒng)，通過采集并解算頭部姿態(tài)，在顯示器中虛擬顯示視野的移動，以滿足玩家對視野范圍的需求，同時提升游戲帶入感。

目前市售的頭部運動跟蹤系統(tǒng)是NaturalPoint公司開發(fā)的Track IR系統(tǒng)，采用了紅外跟蹤原理，具備六自由度頭部運動跟蹤能力。Track IR系統(tǒng)主要由反光架和接收解算組件組成，其中接收解算組件包含紅外光源、廣角接收器、解算器和輸出電路。其工作原理如圖1所示。

圖1 Track IR系統(tǒng)工作原理示意圖

使用Track IR系統(tǒng)時需將反光架固定在頭部，反光架上有3～4組反光鏡，可反射紅外光源發(fā)出的紅外線。反射后紅外線被廣角接收器接收并處理成電子信號，再由解算輸出組件計算處理并輸出。由此可見，在Track IR系統(tǒng)使用中，人體面部將長期受到紅外線照射。同時，反光架不能移出廣角接收器的接收范圍，否則系統(tǒng)無法正常工作。

數(shù)學上，頭部運動跟蹤屬于剛體運動問題，而運動信息包含姿態(tài)和位置。目前，大多數(shù)情況下處理體感問題都采用光學法，如Track IR系統(tǒng)、F-35飛機采用JHMCS頭盔顯示系統(tǒng)等。該方法的最大優(yōu)勢在于原理簡單、感受精確。如果在使用精度要求不高的情況下，還可以采用慣性原理采集和解算頭部運動信息，即本文論述的基于慣性原理的頭部運動跟蹤系統(tǒng)。

1 慣性感測原理

1.1 頭部運動的分析

在飛行模擬游戲中，玩家的頭部運動與飛行員的頭部運動一致，主要以旋轉為主。采用慣性原理采集和計算頭部運動信息，即是對頭部運動的姿態(tài)進行解算。常用的慣性傳感器感受的是物體的角速度。所以在數(shù)學上，該問題簡化為已知剛體角速度求解姿態(tài)的問題，即經典的慣性姿態(tài)問題。

頭部的旋轉運動可分解為三個軸向的旋轉運動，即左右搖擺、上下俯仰和水平滾轉。因此，慣性傳感器應能測量三個軸向的角速度，解算部分將傳感器測得的角速度聯(lián)合解算，得出頭部的運動姿態(tài)。

1.2 慣性感測的數(shù)學原理

經典的慣性姿態(tài)問題有三種常用解法，即歐拉角法、方向余弦法和四元數(shù)法。歐拉角法是通過歐拉角微分方程求解得出剛體的姿態(tài)。歐拉角法的最大難點在于其解中包含“奇點”，故無法對全姿態(tài)進行求解，同時實施控制上難度很大，所以工程上幾乎不采用。方向余弦法采用了方向余弦矩陣求解姿態(tài)，在算法上避免了“奇點”產生，但矩陣數(shù)據量大、計算量大、工作效率低，工程上也很少采用。四元數(shù)

屬于超復數(shù)，四元數(shù)法是采用四元數(shù)表示剛體的姿態(tài)和旋轉。四元數(shù)法算法簡單、效率高、不存在“奇點”解，工程應用廣泛。

四元數(shù)是形如q=q0+q1i+q2j+q3k的數(shù)，其中i、j、k滿足i2=j2=k2=-1，ij=-ji=k，jk=-kj=i，ik=-ki=-j。解算剛體旋轉問題時，需先將歐拉角轉換成四元數(shù)，方程為：

其中：φ為剛體繞x軸旋轉的角度；θ為剛體繞y軸旋轉的角度；ψ為剛體繞z軸旋轉的角度。

四元數(shù)表示了剛體的姿態(tài)和旋轉，用四元數(shù)進行旋轉剛體的姿態(tài)求解即是將兩個四元數(shù)相乘，其中一個四元數(shù)表示剛體的初始姿態(tài)，另一個四元數(shù)表示本次旋轉的角度和旋轉軸，如下式所示。

qi=pqi-1p-1.

其中：qi為旋轉后的剛體姿態(tài)四元數(shù)；qi-1為旋轉前剛體姿態(tài)四元數(shù)；p為旋轉四元數(shù)。

在剛體連續(xù)旋轉過程中，旋轉四元數(shù)p是單位時間內剛體旋轉的角度，可由傳感器獲得的角速度值計算并進行坐標變換得到。而剛體旋轉后的姿態(tài)可由旋轉后的四元數(shù)變換為歐拉角得到。四元數(shù)轉換為歐拉角的公式為：

2 系統(tǒng)設計

基于慣性原理的頭部運動跟蹤系統(tǒng)需要安裝在玩家頭部，所以其系統(tǒng)需求為：體積小、重量輕，易安裝拆卸，自供電，無線輸出。

根據上述要求，系統(tǒng)由慣性傳感器，解算器，輸出部件和電源組成。慣性傳感器選用具有三軸加速度和三軸角速度感受的MPU6050。解算器選用Arduino Nano單片機部件，其處理器核心為ATmega328(Nano3.0)單片機，同時具備14路數(shù)字輸入/輸出口(其中6路可作為PWM輸出)，8路模擬輸入，一個16MHz晶體振蕩器，一個mini-B USB口。輸出部件以藍牙模塊為核心，采用SBM14580S小尺寸藍牙4.0模塊，使系統(tǒng)具備無線通訊的功能。系統(tǒng)電源供電方式可選用USB接口供電或5 V鋰電池組供電。系統(tǒng)原理框圖如圖2所示。

圖2 系統(tǒng)原理框圖

系統(tǒng)單片機程序用Arduino IDE軟件開發(fā)，燒寫到Arduino Nano單片機部件中。流程如圖3所示。

圖3 程序流程圖

3 結論

本文主要研究了基于慣性原理的頭部運動跟蹤系統(tǒng)，證明慣性感測原理可以應用于頭部運動的跟蹤采集和處理。經過測試，本系統(tǒng)可以較好地應用于多種飛行模擬游戲。相對于Track IR系統(tǒng)而言，本系統(tǒng)無需對傳感器的位置范圍作出規(guī)定，也未采用紅外線定位原理，解決了紅外線持續(xù)照射玩家面部的問題。當前流行的虛擬現(xiàn)實和增強現(xiàn)實技術中，對身體運動的感受和處理是其核心技術之一，慣性傳感器的工作不受外界條件和輸入的限制，可以應用于身體其他部位運動的感受和處理，推廣前景良好。

[1] 張榮輝，賈宏光，陳濤，等.基于四元數(shù)法的捷聯(lián)式慣性導航系統(tǒng)的姿態(tài)解算[J].光學精密工程，2008,16(10):1963-1970.

[2] 劉俊峰.三維轉動的四元數(shù)表述[J].大學物理,2004,23(4):39-62

Design of Head Tracking System Based on Inertial Principle

Yang Liu

(ShanxiPolytechnicCollege,TaiyuanShanxi030006,China)

In order to simulate the actual moving visual field of pilot, the head tracking system needs to collect and calculate the data of head movements in the flightsim. The head tracking system on sale uses infrared tracking principle at present. This paper mainly studies the working principle and system design of the head tracking system based on inertial principle. The system can be applied to varied flightsim.

head tracking system; inertial principle; MPU6050; Arduino

2017-01-04

楊 柳(1983- )，女，山西陽泉人，助教，工學碩士，主要從事電子信息技術專業(yè)相關教學及研究。

1674- 4578(2017)02- 0003- 02

TP391.41

A