CN104748746A

CN104748746A - 智能机姿态测定及虚拟现实漫游方法

Info

Publication number: CN104748746A
Application number: CN201410163542.0A
Authority: CN
Inventors: 刘进; 陶重芝
Original assignee: Individual
Current assignee: Wuhan Xiong Chu Gao Jing Technology Co Ltd
Priority date: 2013-12-29
Filing date: 2014-04-23
Publication date: 2015-07-01
Anticipated expiration: 2034-04-23
Also published as: WO2015096806A1; CN105474033A; CN105474033B; CN104748751A; CN104748751B; CN104748746B

Abstract

本发明提供一种智能机姿态测定及虚拟现实漫游方法，用户在三维空间中以任意姿态摆放智能机都能在视窗内观察到与该位姿对应的周边真实或虚拟三维渲染场景。由于用户手持智能机的姿态与三维场景中渲染的三维效果完全一致，用户会体验到一种极其逼真的身临其境三维效果。利用智能机的姿态控制观察角度，手指滑动或移动控制智能机位置，用户可在三维场景中进行漫游，基于本发明可测定智能机的姿态，并实现三维数字城市漫游，商铺广告信息三维发布、虚拟现实电子商务、游戏控制、虚拟地图旅游、摄影测量测绘等。

Description

智能机姿态测定及虚拟现实漫游方法

技术领域

本发明涉及信息技术领域，具体涉及智能机姿态测定及虚拟现实漫游方法。

背景技术

虚拟现实技术是让用户沉浸在智能机显示屏展现的虚拟或真实三维场景中，将虚拟目标标签叠加到其中,提示交互信息给用户。传统的三维虚拟场景，如数字三维城市、游戏等应用已经非常成熟，但是在三维场景里漫游却主要通过鼠标、键盘、滚动球等传统控制设备，控制设备的方向和观察到的实际场景无法直观的对应，渲染设备庞大而笨拙，这都会给操作者带来极大不便，影响了这些三维数字技术的广泛应用。因此迫切需要一种将控制设备与显示设备合二为一的非常直观轻便的智能机定姿态与渲染技术。本发明正解决了这个问题。

由于智能机姿态不一样，同样位置看到的现实场景不一样，智能机姿态精度影响导航精度和虚拟现实漫游仿真精度，因此智能机姿态的精确测定具有重要意义。虚拟现实应用中对智能机姿态精度提出了更高要求。传统的智能机姿态测定，主要利用方向传感器单轴航向角数据信息，系统对智能机姿态摆放有特定要求，如要求智能机平行于地面，或垂直于地面摆放，而虚拟现实应用中用户手持智能机的姿态千变万化，并不一定严格平行或者垂直于地面，这将导致导航方位不准。此外智能机姿态测定的误差将带来虚拟现实漫游误差，影响用户体验，因此迫切需要一种考虑智能机X-Y-Z三轴旋转的姿态测定算法。

基于位置的服务LBS日益受关注，但用户更关心的不仅是位置，而是自己与目标间的方向和距离。很多老年人和方向感不强的人很难将实际看到的生活场景与地图中的东南西北联系在一起，因此智能机任意角度摆放情况下，叠加在实景视频上的目标信息及其相关服务将给用户带来所见即所指的极大便利，将成为未来信息服务的发展新趋势，我们将这种服务称为“智能机全方位虚拟现实或增强现实信息服务”。应用包括：

1. 为商铺以及供需双方发布相对于其他海量用户的方位和距离提供信息；

2. 为用户相对于指定地名，指定单位的方位与距离提供可视化信息服务；

3. 为用户之间相互联络提供方位和距离可视化信息；

4. 为车、船、人、物流提供相对于目的地的方位和距离可视化信息。

5. 快递、送货，用于电子商务的最终递送环节。邮递员通过智能机即可知道收货人，收件人位置，收件人通过智能机知道邮递员位置和方向。

6. 提供一种全新三维场景、数字城市、数字地球、游戏漫游模式，不需手指触碰控制方向，而采用直观的智能机姿态控制保证渲染的地图与三维场景对应。

7. 提供了一种全新的地图浏览查询模式，不需要用手指触碰方式，而是采用直观的智能机姿态控制保证渲染出的地图与实景对应。

传统的导航服务是地图导航服务，用户看到的是智能机姿态与周边实景不对应的地图，用户需要费力的去把实景与地图联想起来才能得到正确的方向。

传统导航服务依据经纬度网格组成的2维坐标系进行导航，地球当做经纬度组成的一个平面处理，因为相同维度差对应的距离偏移≥经度差对应的距离偏移，所以不同地区导航算法需进行经纬比例调整，只适合于中低纬度地区的小区域，不适合全球，极地附近这种方法已经无法再适用，非常不便于全球化普及。而本发明采用局部坐标系转换后能把全球任何位置的三维场景很好地展现出来。

传统的姿态检测技术主要用于飞机，汽车等大型设备，追求很高精度，用于军事、工业等领域，而且非常贵重和笨重，而本发明主要考虑用廉价轻便的智能机终端实现普通个人周边地区的视频信息叠加服务。

本发明不仅考虑方向传感器的value[0]得到的航向角，在有其他传感器，如重力加速度磁力计和陀螺仪情况下，还考虑了其他几种姿态传感器捕获到的数据，使得检测到的姿态更加精确，在没有这些传感器条件下也能得到粗略姿态。本发明可以在智能机，诸如Andriod，苹果系统上方便地实现虚拟现实漫游、地图浏览功能。

考虑到当前智能机传统应用的各种缺陷和不足，本发明提供一种考虑智能机3轴旋转任意姿态测定的虚拟现实或增强现实三维渲染及漫游方法，用户在三维空间中以任意姿态摆放智能机都能在视窗内观察到与该位姿对应的周边真实或虚拟三维渲染场景。由于用户手持智能机的姿态与三维场景中渲染的三维效果完全一致，用户会体验到一种极其逼真的身临其境三维效果。

因此基于本发明可以实现虚拟现实电子商务、虚拟现实商铺广告信息实景三维渲染发布、三维数字城市漫游，实景三维地图标注，实景三维游戏、摄影测量测绘等。同时商铺也能借助服务平台广泛发布其广告信息。

基于本发明可实现电子商务服务，用户客户端之间，用户客户端与商铺之间可以用视频实景预览观察相互之间的位置、方位关系，同时商铺也能借助服务平台广泛发布其广告信息。

本发明中智能机包括一切含显示显示屏和姿态传感的智能设备，如手机，平板电脑，笔记本电脑，带姿态传感和显示屏的摄像头，相机，智能显示器，智能电视机显示屏、以及各种可穿戴设备。

发明内容

本发明所要解决的问题是提供智能机姿态测定及虚拟现实漫游方法，该方法使用户在智能机上获得便捷、直观的可视化信息。

本发明提供的技术方案是，智能机姿态测定及虚拟现实漫游方法，包括以下内容：

智能机姿态测量方法的输入输出定义

输入：

方法(1) 重力加速度计传感器的三个值、、, 要求配置最低，适用性最广

磁力计传感器的三个值{m_x,m_y,m_z} 或方向传感器的航向角value[0]

方法(2) 旋转矢量传感器的三个或四个输出。需旋转矢量传感器

方法(3) 重力加速度计，磁力计和陀螺仪。另需陀螺仪输出：

完整描述智能机局部坐标系姿态的矩阵R_g=

R_g矩阵是一个3x3单位正交矩阵,由三行组成，每行一个三维矢量，三个矢量分别为r_gx,r_gy,r_gz。第一行r_gx是智能机自身x轴在局部坐标系下的单位矢量;

第二行r_gy是智能机自身y轴在局部坐标系下的单位矢量;

第三行r_gz是智能机自身z轴在局部坐标系下的单位矢量。

如图1所示,智能机姿态矩阵R_g的三个行矢量r_gx,r_gy,r_gz是其自身三轴在局部坐标系下的三个单位矢量。

本发明智能机姿态测定方法，包括以下步骤：

测定智能机姿态矩阵R_g _。R_g是一个3x3单位正交矩阵，是相对于局部坐标系的，局部坐标系Z轴与重力方向一致，

若智能机磁力计指示方向是北，则北代表局部坐标系X轴，西代表局部坐标系Y轴;

若智能机磁力计指示方向是东，则东代表局部坐标系X轴，北代表局部坐标系Y轴;

若智能机磁力计指示方向是南，则南代表局部坐标系X轴，东代表局部坐标系Y轴;

若智能机磁力计指示方向是西，则西代表局部坐标系X轴，南代表局部坐标系Y轴;

局部坐标系的原点可以定义为位于地球上任意一点。

R_g由下法之一获得：

方法(1)采用重力加速度计与磁力计

如果智能机有重力加速度计，且有磁力计或方向传感器，用以下公式(1)计算R_g

R_g= (1)

其中

R_θ=

v_ax,v_ay,v_az是智能机测出来的智能机重力加速度传感器的x,y,z三个方向的值，或这三个检测值经过滤波的结果，如过程中检测到新值 v_ax ^’,v_ay ^’,v_az ^’可采用：

αv_ax ^’+(1-α)v_ax替换原来的v_ax

αv_ay ^’+(1-α)v_ay替换原来的v_ay

αv_az ^’+(1-α)v_az替换原来的v_az

α是介于[0,1]之间的一个值。

R_a是重力传感器芯片相对于智能机的姿态转换矩阵。对于大部分智能手机而言，

R_a=

L= 当<0时，s = -1， ≥0时,s = 1；

若采用方向传感器：= value[0] 带入公式(1)计算R_g；

若采用磁力计传感器：{v_mx, v_my, v_mz是是智能机上磁力传感器检测到的三个值或这三个值经滤波的结果，如过程中检测到新值 v_mx ^’,v_my ^’,v_mz ^’可采用：

α_mv_mx ^’+(1-α_m)v_mx替换原来的v_mx

α_mv_my ^’+(1-α_m)v_my替换原来的v_my

α_mv_mz ^’+(1-α_m)v_mz替换原来的v_mz

α_m是介于[0,1]之间的一个值。

计算

其中R_m是磁力计传感器芯片相对于智能机的姿态转换矩阵。对于大部分智能手机而言，

R_m=

再计算

=

利用磁力计计算方位角的三角函数为：

带入公式(1)计算R_g

反复利用上述公式(1)计算 R_g.

若既无磁力计，也无方向传感器，将角初值定为0，并当智能机需要模拟逆时针绕重力方向旋转时增加角，需要模拟顺时针绕重力方向旋转则减小角。

方法(2)用旋转矢量传感器

如果智能机配置有旋转矢量传感器

首先采用下述 (a)(b)(c) 中的一种方式得到 R_g0 矩阵

(a)如果检测到智能机上的旋转矢量传感器只有3个数据values[0], values[1], values[2]

采用以下公式得到

q₁= values[0], q₂= values[1], q₃= values[2],

q₀=

则R_g0矩阵为:

R_g0=

(b)如果检测智能机上的旋转矢量传感器有4个数据，

q₀=values[3], q₁=values[0], q₂=values[1], q₃=values[2]

则R_g0矩阵为:

R_g0=；有的版本的android系统需要先将{values[3], values[0],values[1],values[2]}单位化以后才能作为{q0,q1,q2,q3}使用。

(c)智能机上指定传感器类型为旋转矢量类型,实时得到旋转矢量传感器的观测值利用智能机上的旋转矢量转矩阵函数

将传感器的观测值转换成模型转换矩阵R_44, R₄₄矩阵的左上角3x3子阵是R_g0

然后根据智能机旋转矢量传感器坐标系定义的不同，采取以下几种情况之一得到 R_g:

若旋转矢量传感器的X轴指向东,Y轴指向北,则

R_g=R_g0； (2)

若旋转矢量传感器的X轴指向北,Y轴指向西,则

R_g=R_g0 _；(3)

若旋转矢量传感器的X轴指向南,Y轴指向东,则

R_g=R_g0； (4)

方法(3) 采用陀螺仪迭代方法计算智能机姿态矩阵R_g

若智能机有陀螺仪，可采用以下方法迭代得到 R_g 矩阵：

第 1 步计算 q0,q1,q2,q3 的初值

选用上述公式(1)或(2)(3)(4)计算R_g的初值，然后利用姿态矩阵转4元素成熟技术将R_g矩阵转换成4元素q0, q1，q2，q3

将4元数q0, q1，q2，q3作为以下迭代计算的初值

第 2 步设定 exInt ， eyInt ， ezInt 值为 0

exInt=0，eyInt=0，ezInt=0

第 3 步根据接收到的磁力计矢量 {mx,my,mz}, 得到正确磁场矢量 {wx,wy,wz} ：

先将矢量{mx,my,mz}替换成将其单位化以后的矢量{mx,my,mz}/

得到局部坐标系下磁场的正确的磁场方向矢量{bx,0,bz}

hx = 2×mx×(0.5 - q2×q2 - q3×q3) + 2×my×(q1×q2 - q0×q3) + 2×mz×(q1×q3 + q0×q2);

hy = 2×mx×(q1×q2 + q0×q3) + 2×my×(0.5 - q1×q1 - q3×q3) + 2×mz×(q2×q3 - q0×q1);

hz = 2×mx×(q1×q3 - q0×q2) + 2×my×(q2×q3 + q0×q1) + 2×mz×(0.5 - q1×q1 - q2×q2);

bx = ;

bz = hz

再转换到正确磁场矢量{wx,wy,wz}

wx = 2×bx×(0.5 - q2×q2 - q3×q3) + 2×bz×(q1×q3 - q0×q2);

wy = 2×bx×(q1×q2 - q0×q3) + 2×bz×(q0×q1 + q2×q3);

wz = 2×bx×(q0×q2 + q1×q3) + 2×bz×(0.5 - q1×q1 - q2×q2);

第 4 步根据接收到的重力加速度计数据 ax,ay,az, 和第 3 步得到的正确磁场矢量 {wx,wy,wz} 得到误差矢量 {ex,ey,ez} 并修改 exInt ， eyInt ， ezInt 的值

先将矢量{ax,ay,az}替换成将其单位化以后的矢量{ax,ay,az}/

vx = 2×(q1×q3 - q0×q2); vy = 2×(q0×q1 + q2×q3); vz = q0×q0 - q1×q1 - q2×q2 + q3×q3;

ex = (ay×vz - az×vy) + (my×wz - mz×wy);

ey = (az×vx - ax×vz) + (mz×wx - mx×wz);

ez = (ax×vy- ay×vx) + (mx×wy - my×wx);

计算误差累计值

exInt替换为exInt+ex×Ki; eyInt替换为eyInt+ey×Ki; ezInt替换为ezInt+ez×Ki;

其中Ki为一可调节的正系数，Ki在0.00001至 0.5中任意选取；

第 5 步根据误差矢量 {ex,ey,ez} 及其累计值将陀螺仪数据 {gx0,gy0,gz0} 纠正成 {gx,gy,gz}

假设智能机读出当前的一组陀螺仪数据为 {gx0,gy0,gz0} gx= gx0+Kp×ex + exInt; gy= gy0+Kp×ey + eyInt; gz = gz0+Kp×ez + ezInt;

其中Kp为一可调节的正系数

Kp在0.000001至 20.0中任意选取；

第 6 步根据陀螺仪数据 gx,gy,gz 修正四元数

随着不断接收到陀螺仪数据gx, gy, gz，对4元数按如下方式修正，halfT为修正周期， halfT=0.00001~-10.0，

q₀替换为q₀+ (-q₁×gx - q₂×gy – q₃×gz)×halfT; q₁替换为q₁+ (q₀×gx - q₃×gy + q₂×gz)×halfT; q₂替换为q₂+ (q₃×gx + q₀×gy - q₁×gz)×halfT; q₃替换为q₃+ (-q₂×gx + q₁×gy + q₀×gz)×halfT;

第 7 步输出 4 元数和 R_g 矩阵

将四元数{q0,q1,q2,q3}单位化成{q0,q1,q2,q3} /

4元数转R_g矩阵公式如下

R_g=

第 8 步 回到第 3 步继续接收陀螺仪运动数据更新姿态 4 元数 q₀~q₃ ，在循环的过程中每次到第 7 步都能输出当前的 R_g 矩阵；

本发明测定智能机上显示屏姿态的方法:

定义智能机上显示屏的姿态矩阵为

rx是显示屏水平方向在局部坐标系中的分量；

ry是显示屏上下方向在局部坐标系中的分量；

rz是垂直于显示屏表面方向向显示屏内部看的视线方向在局部坐标系中的分量。

包括以下步骤：

1）按本发明测定智能机姿态的方法，得到智能机的姿态矩阵R_g；

2）计算R=∆R×R_g；得到显示屏的姿态R矩阵

∆R为智能机显示屏姿态矩阵R相对于智能机姿态矩阵R_g的一个固定的方向的转换，当显示屏观察方向和智能机自身Z轴方向刚好相反时∆R=，当显示屏观察方向和智能机自身Z轴方向完全一致时∆R=，否则可在智能机上选择一个与显示屏xyz三轴姿态一致的摄像头，采用成熟摄影测量后方交汇法通过摄像头精确标定∆R。方法如下：

1. 建立控制场坐标系，即原点位于智能机的GPS接收点或北斗定位点的局部坐标系；

2. 用智能机摄像头拍摄控制场坐标系中的点集；按权利要求1方法测定智能机拍摄点集时的R_g，R_g也是相对于控制场坐标系定义的;

3. 根据控制场点集中各已知点转换到控制场坐标系的3维坐标与拍摄图像中点集像坐标的对应关系，采用摄影测量后方交会方法测量出智能机摄像头相对于控制场坐标系的姿态矩阵R_A和摄像头光心相对于控制场坐标系的坐标∆T；

4. 按下式得到∆R=R_AR_g ^-1。

∆T同时也是摄像头光心，近似为显示屏中心，相对于智能机GPS或北斗定位点的局部坐标系偏移；

通过测定该摄像头的姿态R得到虚拟现实中智能机显示屏观察姿态矩阵R。

本发明还提供了基于智能机姿态的虚拟现实漫游方法:

基于前述方法得到智能机显示屏姿态矩阵R矩阵，采用以下步骤：

1 ）采用本发明方法得到与智能机显示屏姿态一致的摄像头姿态 R 即为智能机显示屏姿态矩阵 R

若无此摄像头，则当智能机自身姿态Z轴方向和智能机显示屏观察姿态方向相反时R=，当智能机自身姿态Z轴方向和智能机显示屏观察姿态方向一致时R=R_g.

2 ）移动控制漫游观察者在局部坐标系中的位置

定义漫游观察者是在局部坐标系中的一个具备自身位置、姿态、用于观察周边场景的对象。智能机显示屏所渲染的场景就是漫游观察者在局部坐标系中所应看到的场景图像；

定义漫游观察者在局部坐标系中的坐标为 Xd,Yd,Zd

用以下三种方法之一控制漫游观察者在虚拟场景中的移动：

(1) 模式1:普通2维移动

当用户手指按{∆X,∆Y}方向滑过智能机显示屏平面的时候，相当于局部坐标系下, Xd增加Vx=∆Xr₁₁+∆Yr₂₁；Yd增加Vy=∆Xr₁₂+∆Yr₂₂；Zd 不变

此方法主要适合于智能机显示屏接近水平时的情况。

(2) 模式2:智能2维移动

当手指按{∆X,∆Y}方向滑过智能机显示屏平面的时候，采用如下方法：

首先选择R矩阵右侧一列中的r13,r23,r33中哪一个分量的绝对值最大，

如果|r33|最大，Xd增加Vx=∆Xr₁₁+∆Yr₂₁Yd增加Vy=∆Xr₁₂+∆Yr₂₂

如果|r23|最大，Xd增加Vx=∆Xr₁₁+∆Yr₃₁Yd增加Vy=∆Xr₁₂+∆Yr₃₂

如果|r13|最大，Xd增加Vx=∆Xr₃₁+∆Yr₂₁Yd增加Vy=∆Xr₃₂+∆Yr₂₂

(3) 模式3: 3维漫游移动

因为手机显示屏只有2维，单个手指滑动只能进行2维操作，单指划过手机显示屏时∆X,∆Y与滑动位移成正比，那么可采用用户双指滑动触碰智能机操作实现3维操作，采用双指合拢相当于∆Z<0,双指拉开相当于∆Z>0(或者双指合拢相当于∆Z>0,双指拉开相当于∆Z<0)。当智能机接收到手指控制信息{∆X,∆Y,∆Z}的时候,

Xd增加Vx=∆Xr₁₁+∆Yr₂₁+∆Zr₃₁Yd增加Vy=∆Xr₁₂+∆Yr₂₂+∆Zr₃₂Zd增加Vz=∆Xr₁₃+∆Yr₂₃+∆Zr₃₃

3 ）设置漫游观察者在局部坐标系里的位置和方向：

根据漫游观察者的局部坐标系坐标Xd,Yd,Zd，以及步骤1测定得到的姿态矩阵R，利用OpenGL，OpenES，OS X OpenGL，Direct3D或osg绘图软件库中用于设定虚拟观察相机位姿的图形库函数，设置漫游观察者在局部坐标系里的位置和方向：

需要设定以下几个量:

1.漫游观察者自身观察的垂直视场角，就是智能机显示屏上边缘中点的视线方向与下边缘中点的视线方向的夹角。通常可选取=45度.

2漫游观察者所在的位置X_d,Y_d,Z_d，由步骤2漫游算法修改；

3.漫游者观察方向{r₃₁, r₃₂ r₃₃}或者用户注视点坐标(X_d +r₃₁, Y_d + r₃₂, Z_d + r₃₃)

4.漫游者自身向上方向的矢量{-r₂₁, -r₂₂, -r₂₃}

其中r_ij是智能机显示屏姿态R矩阵中的第i行j列

比如在Android OpenES中采用

GLU.gluLookAt(gl, (float)Xd, Yd, Zd,

Xd + r₃₁, Yd + r₃₂, Zd+ r₃₃,

- r₂₁, - r₂₂, - r₂₃);

其中r_ij是R矩阵第i行j列的元素值

编程实现设置漫游观察者位置和姿态

4) 在局部坐标系下渲染绘制三维场景

预先在智能机的可视显示屏内设置一个3维渲染图层进行三维场景渲染，可视窗口内预先叠加视频或地图图层；

这里被绘制的三维场景中的点、线、面和物体模型的几何坐标都要转换成局部坐标系下的坐标 [Xi Yi Zi]^T ,即与漫游者的坐标Xd,Yd,Zd在同一个局部坐标系下；用OpenGL，OpenES，OS X OpenGL，Direct3D或osg绘图软件库实现局部坐标系下的三维绘图。

在上述步骤4)中，在局部坐标系中绘制一个标有广告符号、文字的纹理多边形面或模型定义为广告牌。将广告牌的实际地理坐标转换到局部坐标系，再按如下三种方法渲染绘制都可使得广告牌的正面始终正对着漫游观察者。

方法1

(a) 假设商铺广告牌的局部坐标系坐标在Xi Yi Zi，按如下方法设置模型绘制转换矩阵：

∆Xi=Xi-Xd ∆Yi=Yi-Yd

m[16]=

{ ∆Xi/L ∆Yi/∆L 0 0}

{-∆Yi/L ∆Xi/∆L 0 0}

{ 0 0 1 0}

{ Xi Yi Zi 1}

∆L=

将m设定为模型转换矩阵。

(b) 在y-z平面上绘图即可让广告牌永远正对智能机方向

方法2

(a)假设商铺广告牌的局部坐标系坐标在Xi Yi Zi，按如下方法设置模型绘制转换矩阵：

∆Xi=Xi-Xd ∆Yi=Yi-Yd

m[16]=

{-∆Yi/∆L ∆Xi/∆L 0 0}

{ ∆Xi/∆L ∆Yi/∆L 0 0}

{ 0 0 1 0}

{ Xi Yi Zi 1}

将m设定为模型转换矩阵。

(b)在x-z平面上绘图即可让广告牌永远正对智能机方向方法(1)(2)绘制出来的广告牌都具有近大远小的立体效果。

方法3

∆Xi=Xi-Xd ∆Yi=Yi-Yd

m[16]=

{-∆Yi ∆Xi 0 0}

{ ∆Xi ∆Yi 0 0}

{ 0 0 ∆L 0}

{ Xi Yi Zi 1}

将m设定为模型转换矩阵。

(b) 在x-z平面上绘图即可让广告牌永远正对智能机方向

这样绘制出来的广告牌将不具有近大远小的效果，远近一样大，方便用户观察。

上述渲染的商铺信息内容包括名称、符号属性、类别、与智能机的距离、角度和/或高度。

根据智能机的真实地理坐标进行虚拟现实漫游：

本发明设定局部坐标系原点是智能机显示屏中心,即X_d,Y_d,Z_d是相对于智能机显示屏中心的局部偏移坐标，步骤4）之前增加如下操作：

(a) 获取智能机的高度h_s,纬度θ_s和经度φ_s

θ_s是智能机的纬度，φ_s是智能机的经度,由智能机上自带的GPS接受模块获取；

(b) 计算智能机所在经纬度的R_v

R_v=

(c) 计算智能机所在纬度θ_s经度φ_s高度h_s的地心坐标系坐标T_s

利用大地测量学中经典的转换公式。

其中

h_s是智能机离地面高度

N_s 是随纬度变化的卯酉圈曲率半径。

a,b是地球椭球的长短轴，是大地测量学中的已知常量；

e是偏心率，是定值。

(d) 根据地球上任何一个点的经度φ_i、纬度θ_i和高程h_i得到该点地心坐标系坐标T_0i=[X_0i Y_0i Z_0i]^T

利用大地测量学中经典的转换公式

其中

h_i是点离地面高度

N 是随纬度变化的卯酉圈曲率半径。

a,b是地球椭球的长短轴，是大地测量学中的已知常量；

e是偏心率，是定值。

如果已知一个物体所在经纬度φ_i和θ_i，通过本步骤计算出它的地心坐标系坐标T_0i

(e) 地心坐标系坐标T_0i转换为局部坐标系中的坐标(X_i Y_i Z_i)^T

∆T是智能机显示屏中心相对于智能机GPS接收天线的局部坐标系偏移。这样保证了权利要求3中的(X_i Y_i Z_i)^T和(X_d Y_d Z_d)^T都是相对于智能机显示屏中心的偏移坐标。可近似取∆T=[0 0 0]^T

权利要求3中步骤4）中绘制三维场景须用这种转换为局部坐标系中的坐标(Xi Yi Zi)^T。

在基于智能机姿态的虚拟现实漫游方法步骤2)中设置加速度模拟漫游效果：

步骤2)中如果需要模拟加速度漫游移动特效，当手指滑动的时候，根据手指滑动速度大小给予一个初速度{V_x,V_y,V_z}，Xd,Yd,Zd将不停地增加速度分量Vx,Vy,Vz，然后让速度分量V_x,V_y,V_z随时间推移不断衰减，其中V_Z在权利要求3步骤2)模式1，2情况下恒等于零。

让速度体现到局部坐标系下的漫游位移

X_d增加Vx

Y_d增加Vy

Z_d增加Vz仅用于权利要求3步骤2)模式3

最后要在不停的移动过程中速度大小不断衰减，

V_x,V_y,V_z不停地衰减：可采用以下两种方法：

1) 运动过程中Vx, Vy, Vz自身分别不断地乘以k=0.1~0.9999进行衰减，

运动过程中Vx自身不断地乘以k，直到Vx减小为0为止；

运动过程中Vy自身不断地乘以k，直到Vy减小为0为止；

运动过程中Vz自身不断地乘以k，直到Vz减小为0为止；

或者

2) 运动过程中Vx, Vy, Vz自身分别不断地进行以下增量操作

Vx自身不断地增加-Vx*k，直到Vx减小为0为止；

Vy自身不断地增加-Vy*k，直到Vy减小为0为止；

Vz自身不断地增加-Vz*k，直到Vz减小为0为止；

其中k=0.0001~0.5

以上过程不断循环即可实现局部加速度漫游效果。

本发明还涉及虚拟现实场景中的2维标签的恒水平于地面的显示方法：

2维标签是指2维文字、图符、图片、标记、编码、对话框、编辑框、列表框等一切在智能机显示屏中以2维形式显示的对象。

因用户双眼是水平于地面的，前述基于智能机姿态的虚拟现实漫游方法只能保证3维物体能正确显示，2维标签的显示姿态会随智能机旋转而旋转，用户看到的标签就不是正放的。故设计本方法使得标签始终正放显示。方法不局限于矩形显示屏，对常用矩形显示屏而言，采用以下方法。

在前述基于智能机姿态的虚拟现实漫游方法步骤3和步骤4）之间或步骤4)结束之后，将显示屏设定为2维绘图模式并设置若干个2维标签，针对每一个2维标签，按如下步骤显示：

步骤1）首先确定虚拟现实场景中2维标签的中心位置u,v;

如果标签用于标注三维场景中局部坐标系坐标为(X,Y,Z)的目标，则根据以下公式确定目标显示的中心位置u, v

Z_O=

式中： w是智能机显示屏宽度，h是智能机显示屏高度。

r₁₁~r₃₃是权利要求2所述的方法中的R矩阵对应行列的元素。

f= 是垂直视场角

Xd,Yd,Zd是漫游观察者在局部坐标系中的坐标。

如果满足Z_O>0且0<u<w且0<v<h则u,v保持不变,

否则需要按下法修正u,v

若Z_O=0则将[u v]替换为从点(w/2,h/2)出发

按矢量{r₁₁(X-X_d)+r₁₂(Y-Y_d)+r₁₃(Z-Z_d), r₂₁(X-X_d)+r₂₂(Y-Y_d)+r₂₃(Z-Z_d)}

方向的射线与显示屏边缘相交的2维点。若Z_O>0则将[u v]替换为点(w/2,h/2)到(u,v)的连线与显示屏边缘相交的2维点。

若Z_O<0则将[u v]替换为点(u,v)到(w/2,h/2)的延长线与显示屏边缘相交的2维点。

如果标签不是用于标注目标，u,v为界面设计者设定的显示屏坐标，或是用户手指或鼠标点击的显示屏坐标。

步骤2）计算矢量{Qx,Qy}

方法(1)Qx=-r₂₃/La Qy=r₁₃/La

其中r₂₃, r₁₃是权利要求2所述的方法中的R矩阵对应行列的元素,

La=

方法(2)利用权利要求1方法(1)所述加速度计的前两个输出值ax,ay得到

Qx=-ay/La Qy=ax/La, La=

步骤3）在2维平面上经过以下矩阵旋转变换以后再绘制2维标签：

2维标签上每一点X，经过上式变换到坐标X’显示出来。

取+是正放显示，取-是倒放显示，标签的水平轴始终平行于地面。

就会看到显示屏上该显示对象自身的水平轴始终平行于地平面，标签始终处于正放状态。

在基于智能机姿态的虚拟现实漫游方法的步骤4)中所述三维场景为一个空心的三维形体，三维形体可以是球，立方体、柱体、正多面体、锥体，三维形体的内壁以全景图作为纹理进行渲染。所述漫游观察者在虚拟场景中位于三维形体内部的某一固定点[Xd，Yd，Zd]=[0,0,0]，一般位于三维形体中心，从三维形体内部观察三维形体的内壁纹理，实现利用智能机显示屏姿态R矩阵控制全景浏览。

本发明进一步提供了控制局部坐标系中三维物体姿态的方法：

将R_g矩阵设定为仿真软件系统中的模型转换矩阵M的左上角3x3矩阵M₄₄=

这实现了利用智能机姿态控制三维场景中某一物体的姿态。

附图说明

图1为智能机姿态矩阵R的三个行矢量r_gx,r_gy,r_gz 在局部坐标系中的所指的矢量方向。

具体实施方式

本发明针对3种方法需要智能机的3种配置类型的传感器输入

方法(1) 用以下公式R_g=计算R_g

其中

R_θ=

=

利用磁力计计算方位角的三角函数为：

在实际操作中，若出现地磁偏角△导致磁力方向不是指着正北，可通过下式计算R_g

R_g=

重力加速度计传感器的三个值{v_ax, v_ay, v_az}要求配置最低，适用性最广;

磁力计传感器的三个值{v_mx, v_my, v_mz} 或方向传感器的航向角value[0]

若既无磁力计，也无方向传感器，角可通过用户界面滑块控制增减φ角。往地心看绕重力方向，模拟逆时针旋转时角增加，模拟顺时针旋转时角减小。

方法(2) 旋转矢量传感器的三个或四个输出,需旋转矢量传感器。

方法(3) 重力加速度计，磁力计和陀螺仪,另需陀螺仪。

计算过程中，很多变量如L和可以预存下来，避免重复计算，以提高速度。

本发明输出矩阵 R_g 的几何意义如下

完整描述智能机局部坐标系姿态的矩阵R_g=

第二行r_gy是智能机自身y轴在局部坐标系下的单位矢量;

第三行r_gz是智能机自身z轴在局部坐标系下的单位矢量。

(1) 智能机显示屏的姿态测定方法中，

显示屏观察方向和智能机自身Z轴方向刚好相反时∆R=，显示屏观察方向和智能机自身Z轴方向完全一致时∆R=，否则可在智能机上选择一个与显示屏观察方向一致的摄像头，该摄像头的拍摄方向一定与观察显示屏的方向一致，通过摄影测量后方交汇法测定该摄像头的局部坐标系姿态R_A以及对应的智能机姿态矩阵R_g, 采用∆R= R_AR_g ^-1精确标定摄像头。

因∆R描述了显示屏观察姿态和智能机自身姿态之间的固定转换关系，一旦精确测定以后，就是一个恒定值。任意给定R_g就可得到对应的显示屏姿态R=∆RR_g。

基于智能机姿态的虚拟现实漫游描述的方法可用于与地理位置无关的虚拟现实漫游领域，如非实景地形游戏，体感游戏、三维虚拟数据仿真，虚拟全景等领域；

用户可采用实际旋转智能机的方式操控智能机姿态，所对准的方向和姿态在虚拟现实场景中观察的内容与其显示屏上显示的是对应的，采用手指滑动方式操纵控制在虚拟现实中平移。

基于智能机姿态的虚拟现实漫游步骤3的具体实施方式如下，

将显示屏设定为3维绘图模式可采用android系统中以下OpenES语句编程实现：

gl.glMatrixMode(GL10.GL_PROJECTION);// 开始设置投影矩阵

gl.glLoadIdentity();// 下面转换成二维平面信息绘制模式

GLU.gluPerspective(gl, , 屏宽/屏高, 0.01, (float) 1000000); 可选取=45度

在Android OpenES中采用

GLU.gluLookAt(gl, Xd, Yd, Zd,

Xd + r₃₁, Yd + r₃₂, Zd+ r₃₃,

- r₂₁, - r₂₂, - r₂₃);

在OpenGL里可采用以下语句实现

gluLookAt(X_d, Y_d, Z_d,

X_d +r₃₁, Y_d + r₃₂, Z_d + r₃₃,

- r₂₁, -r₂₂, -r₂₃)

其中r_ij是R矩阵第i行j列的元素值

编程实现设置漫游观察者位置和姿态

广告牌渲染效果通过如下方法实现：

∆Xi=Xi-Xd ∆Yi=Yi-Yd

以上方法可采用OpenGL中的

m[16]= {-∆Yi，∆Xi，0，0，∆Xi，∆Yi，0，0，0，0，L, 0, Xi, Yi, Zi, 1}

glMultMatrixf(m,0);语句编程实现

或

OpenES中的

gl.glMultMatrixf(m,0);语句编程实现

根据智能机的真实地理坐标进行虚拟现实漫游中描述的方法可用于与地理位置有关的应用，如地图漫游，数字城市、飞行模拟三维漫游。在没有高程数据的情况下可以直接将图片绑定成纹理绘制在X,Y平面上，有高程信息条件下，可结合高程信息在虚拟现实XYZ空间中绘制出三维网格地形，实现智能机姿态结合手指滑动控制地图漫游。

漫游加速度模拟中可在软件中将Vx,Vy,Vz的衰减计算过程放在渲染线程中计算，也可以单独用一个线程处理。

智能机显示屏恒水平显示是指不论怎样绕X,Y,Z三轴任意转动智能机，智能机显示屏上2维标签自身的水平轴始终平行于地平面。

可将要显示的2维标签中的文字、标签，对话框等作为纹理绑定到内存。渲染的时候将此纹理渲染在经过

m=

变换的多边形上。

因用户的双眼是平行于地平面的，所以不论智能显示器怎么旋转，其上显示的2维标签总能给观众一个正确的姿态显示效果。

可通过glMultMatrix(m);实现

其中m=

实现；

也可先Translatef(u,v,0)，然后glMultMatrix(m);实现

其中m=

接着智能机姿态的虚拟现实漫游方法步骤4）之后，

将显示屏设定为2维绘图模式可采用android系统中的以下OpenES语句编程实现：

gl.glLoadIdentity();// 下面转换成二维平面信息绘制模式

gl.glViewport(0, 0, A_Main.screenWidth, A_Main.screenHeight);

gl.glMatrixMode(GL10.GL_PROJECTION);// 开始设置投影矩阵

gl.glLoadIdentity();// 下面转换成二维平面信息绘制模式

gl.glOrthof(0, A_Main.screenWidth, A_Main.screenHeight, 0, -100, 100);

gl.glMatrixMode(GL10.GL_MODELVIEW);// 开始设置模型绘制矩阵

全景浏览方法中的三维形体一般采用球，立方体，正多面体这样的对称形状，漫游观察者一般位于对称体内部中心点。可采用ALPHA检测技术对球面纹理进行渲染。

控制局部坐标系中三维物体姿态的方法中可以用智能机姿态或者智能机显示屏姿态操纵物体，如果是智能机姿态操纵，采用矩阵R_g计算；如果是智能机显示屏姿态操纵，采用矩阵R计算。

应当理解的是，对本领域普通技术人员来说，可以根据上述说明加以改进或变换，而所有这些改进和变换都应属于本发明所附权利要求的保护范围。

Claims

1.智能机姿态测定方法，包括以下步骤：

1）定义局部坐标系：局部坐标系是指原点在智能机，Z轴指向地球表面法方向,Y轴或X轴与纬线相平行的坐标系；或局部坐标系原点位于地球上任意一点，Z轴与重力方向一致，且

2）测定智能机姿态矩阵R_g

R_g是一个相对于局部坐标系的3x3单位正交矩阵，

R_g由下法之一获得：

方法(1)采用重力传感器与磁力计或方向传感器

如果智能机有重力传感器，且有磁力计或方向传感器，用以下公式(1)计算R_g

(1)

其中

v_ax,v_ay,v_az是智能机测出来的智能机重力加速度传感器的x,y,z三个方向的值，或是这三个值经滤波的结果；

R_a是重力传感器芯片相对于智能机的姿态转换矩阵；

L=若智能机检测到的重力加速度传感器定义为负值：当≤0时，s = 1，>0时,s = -1；若智能机检测到的重力加速度传感器定义为正值：当≤0时，s = -1，>0时,s = 1；

若采用方向传感器：= value[0] 带入公式(1)计算R_g；

若采用磁力计传感器：计算

其中R_m是磁力传感器芯片相对于智能机的姿态转换矩阵；{v_mx, v_my, v_mz }是智能机上磁力传感器检测到的三个值或这三个值经滤波的结果；

再计算

利用磁力计计算方位角的三角函数为：

带入公式(1)即可算出R_g;

若既无磁力计，也无方向传感器，角初值为0，当模拟逆时针绕重力方向旋转时增加φ角，模拟顺时针绕重力方向旋转则减小角；

方法(2)用旋转矢量传感器

如果智能机配置有旋转矢量传感器

采用以下公式得到

q₁= values[0], q₂= values[1], q₃= values[2],

q₀=

则R_g0矩阵为:

R_g0=

(b)如果检测智能机上的旋转矢量传感器有4个数据，

q₀=values[3], q₁=values[0], q₂=values[1], q₃=values[2]

则R_g0矩阵为:

R_g0=；

(c)智能机上指定传感器类型为旋转矢量类型TYPE_ROTATION_VECTOR,实时得到旋转矢量传感器的观测值；利用智能机上的旋转矢量转矩阵函数

将传感器的观测值转换成绘图转换矩阵R_44, R₄₄矩阵的左上角3x3子阵是R_g0；

若旋转矢量传感器的X轴指向东,Y轴指向北,则

R_g=R_g0； (2)

若旋转矢量传感器的X轴指向北,Y轴指向西,则

R_g=R_g0 _；(3)

若旋转矢量传感器的X轴指向南,Y轴指向东,则

R_g=R_g0； (4)

方法(3)采用陀螺仪、加速度计与磁力计迭代

第1步选用方法(1)或方法(2)计算R_g的初值，将R_g转换成4元数q0,q1,q2,q3作为以下第2-7步迭代的初值

第2步设定exInt，eyInt，ezInt原始值为0

exInt=0，eyInt=0，ezInt=0

第3步根据接收到的磁力计矢量{mx,my,mz},得到正确磁场矢量{wx,wy,wz}

先将矢量{mx,my,mz}替换成将其单位化以后的矢量{mx,my,mz}/

得到局部坐标系下磁场的正确的磁场方向矢量{bx,0,bz}

bx = ;

bz = hz

再转换到正确磁场矢量{wx,wy,wz}

wx = 2×bx×(0.5 - q2×q2 - q3×q3) + 2×bz×(q1×q3 - q0×q2);

wy = 2×bx×(q1×q2 - q0×q3) + 2×bz×(q0×q1 + q2×q3);

wz = 2×bx×(q0×q2 + q1×q3) + 2×bz×(0.5 - q1×q1 - q2×q2);

第4步根据接收到的重力加速度计数据ax,ay,az,和{wx,wy,wz}

得到误差矢量{ex,ey,ez}并计算其累计值exInt，eyInt，ezInt

先将矢量{ax,ay,az}替换成将其单位化以后的矢量{ax,ay,az}/

vx = 2*(q1*q3 - q0*q2); vy = 2*(q0*q1 + q2*q3); vz = q0*q0 - q1*q1 - q2*q2 + q3*q3;

ex = (ay×vz - az×vy) + (my×wz - mz×wy);

ey = (az×vx - ax×vz) + (mz×wx - mx×wz);

ez = (ax×vy- ay×vx) + (mx×wy - my×wx);

计算误差累计值

其中Ki为一可调节的正系数，Ki在0.00001至 0.5中任意选取；

第5步根据误差矢量{ex,ey,ez}及其累计值纠正陀螺仪数据{gx0,gy0,gz0}

假设智能机读出当前的一组陀螺仪数据为{gx0,gy0,gz0} gx= gx0+Kp×ex + exInt; gy= gy0+Kp×ey + eyInt; gz = gz0+Kp×ez + ezInt;

其中Kp为一可调节的正系数

Kp在0.000001至 20.0中任意选取；

第6步根据陀螺仪数据gx,gy,gz修正四元数

第7步输出R_g矩阵和四元数

将四元数{q0,q1,q2,q3}单位化成{q0,q1,q2,q3} /输出

4元数转R_g矩阵公式如下

第8步回到第3步继续接收陀螺仪运动数据更新姿态4元数q₀~q₃，在循环的过程中每次到第7步都能输出当前的R_g矩阵和四元数。

2.智能机显示屏的姿态测定方法，包括以下步骤：

智能机显示屏的姿态矩阵为

r_x是智能机显示屏像素阵列x轴方向在局部坐标系中的分量；

r_y是智能机显示屏像素阵列y轴方向在局部坐标系中的分量；

r_z是垂直于智能机显示屏表面方向向智能机显示屏内部朝前看的视线方向在局部坐标系中的分量;

1）按权利要求1的方法测定智能机姿态，并得到智能机的姿态矩阵R_g；

2）计算R=∆R×R_g；得到智能机显示屏的姿态矩阵；

∆R为智能机显示屏姿态矩阵R相对于智能机姿态矩阵R_g的一个固定的方向的转换，

智能机自身Z轴定义为智能机加速度计的z轴方向，

当显示屏观察方向和智能机自身Z轴方向刚好相反时∆R=；

当显示屏观察方向和智能机自身Z轴方向完全一致时∆R=；

否则可在智能机上选择一个与智能机显示屏姿态一致的摄像头，即摄像头的xyz三轴分别与显示屏的xyz三轴平行且方向一致，采用摄影测量后方交会方法测量出智能机摄像头相对于局部坐标系的姿态矩阵R_A, 并用权利要求1方法测得此时智能机的姿态矩阵R_g，得到∆R=R_AR_g ^-1。

3. 基于智能机姿态的虚拟现实漫游方法，包括以下步骤：

1）采用权利要求2方法得到智能机显示屏的姿态矩阵R，

2）移动控制漫游观察者在局部坐标系中的位置

定义漫游观察者是在局部坐标系中的一个具备自身位置、姿态且用于观察周边场景的对象；智能机显示屏所渲染的场景就是漫游观察者在局部坐标系中所应看到的场景图像；

定义漫游观察者在局部坐标系中的坐标为Xd,Yd,Zd

用以下三种模式之一控制漫游观察者在虚拟场景中的移动：

(1) 模式1:普通二维移动

当手指按{∆X,∆Y}方向滑过智能机显示屏平面的时候，相当于局部坐标系下,

Xd增加Vx=∆Xr₁₁+∆Yr₂₁；Yd增加Vy=∆Xr₁₂+∆Yr₂₂；Zd不变；

(2) 模式2:智能二维移动

如果|r23|最大，Xd增加Vx=∆Xr₁₁±∆Yr₃₁Yd增加Vy=∆Xr₁₂±∆Yr₃₂

r23≥0时，±取+；r23<0时±取 - 或者r23≥0时，±取-；r23<0时±取 +

如果|r13|最大，Xd增加Vx=±∆Xr₃₁+∆Yr₂₁Yd增加Vy=±∆Xr₃₂+∆Yr₂₂

r13≥0时，±取+；r13<0时±取 - 或者r13≥0时，±取-；r13<0时±取 +；

(3) 模式3: 三维漫游移动

因为智能机显示屏只有二维，单个手指滑动只能进行二维操作，单指划过手机显示屏时∆X和∆Y与滑动位移成正比；此时操作智能机的用户双指滑动触碰智能机操作实现3维操作：采用双指合拢相当于∆Z<0,双指拉开相当于∆Z>0，或者双指合拢相当于∆Z>0,双指拉开相当于∆Z<0；当智能机接收到手指控制信息{∆X,∆Y,∆Z}的时候,

Xd增加Vx=∆Xr₁₁+∆Yr₂₁+∆Zr₃₁Yd增加Vy=∆Xr₁₂+∆Yr₂₂+∆Zr₃₂Zd增加Vz=∆Xr₁₃+∆Yr₂₃+∆Zr₃₃；

3 ）设置漫游观察者在局部坐标系里的位置和方向：

根据漫游观察者的局部坐标系坐标Xd,Yd,Zd，以及步骤1）测定得到的姿态矩阵R，利用OpenGL，OpenES，OS X OpenGL，Direct3D或osg绘图软件库中用于设定相机位姿的图形库函数，设置漫游观察者在局部坐标系里的位置和方向：

需要设定以下几个量:

（1）漫游观察者自身观察的垂直视场角，就是智能机显示屏上边缘中点的视线方向与下边缘中点的视线方向的夹角；

（2）漫游观察者所在的位置X_d,Y_d,Z_d，由步骤2)漫游方法修改；

（3）漫游者观察方向{r₃₁, r₃₂ r₃₃}或者用户注视点坐标(X_d +r₃₁, Y_d + r₃₂, Z_d + r₃₃)

（4）漫游者自身向上方向的矢量{-r₂₁, -r₂₂, -r₂₃}

其中步骤（3）和（4）中的r_ij是智能机显示屏姿态R矩阵中的第i行j列，i=2或3，j=1、2或3；

4) 在局部坐标系下渲染绘制三维场景

预先在智能机的显示屏内设置一个3维渲染图层进行三维场景渲染；

这里被绘制的三维场景中的点、线、面和物体模型的几何坐标都要转换成局部坐标系下的坐标 [Xi Yi Zi]^T ,即与漫游者的坐标X_d,Y_d,Z_d在同一个局部坐标系下；用OpenGL，OpenES，OS X OpenGL，Direct3D或osg绘图软件库实现局部坐标系下的三维绘图。

4. 根据权利要求3所述的方法，其特征在于：步骤4）中几何坐标转换到局部坐标系下之后，再按如下三种方法之一渲染绘制使得局部坐标系中的一个标有广告符号、文字的纹理多边形面或广告牌的正面始终正对着漫游观察者：

方法 1 ：

假设广告符号、文字的纹理多边形面或广告牌的局部坐标系坐标在Xi Yi Zi，按下法设置模型绘制转换矩阵M₄₄：

∆X_i=X_i-X_d ∆Yi=Yi-Y_d

M₄₄是一个4x4矩阵，其中每一元素的值如下设定

M₄₄=

△L=

将M₄₄设定为模型转换矩阵；在y-z平面上绘图即可在虚拟场景中让广告符号、文字的纹理多边形面或广告牌永远正对漫游观察者；

方法 2 ：

(a)假设广告符号、文字的纹理多边形面或广告牌的局部坐标系坐标在Xi Yi Zi，按如下方法设置模型绘制转换矩阵M₄₄：

∆Xi=Xi-X_d ∆Yi=Yi-Y_d

M₄₄是一个4x4矩阵，其中每一元素的值如下设定

M₄₄=

将m设定为模型转换矩阵；

(b)在x-z平面上绘图即可在虚拟场景中让广告牌永远正对漫游观察者；

方法 3 ：

假设广告符号、文字的纹理多边形面或广告牌的局部坐标系坐标在Xi Yi Zi，按如下方法设置模型绘制转换矩阵M₄₄：

∆Xi=Xi-X_d ∆Yi=Yi-Y_d

M₄₄是一个4x4矩阵，其中每一元素的值如下设定

M₄₄=

将m设定为模型转换矩阵；在x-z平面上绘图即可在虚拟场景中让多边形面或广告牌永远正对漫游观察者。

5.根据权利要求3所述的方法，其特征在于：

在所述步骤3）和步骤4）之间增加如下操作：

(a) 获取智能机的高度 h_s, 纬度θ _s 和经度φ _s

(b) 计算智能机所在经纬度的 R_v

R_v=

(c) 计算智能机所在纬度θ _s 经度φ _s 高度 h_s 的地心坐标系坐标 T_s

利用大地测量学中经典的转换公式

得到T_s；

其中

h_s是智能机离地面高度

N_s 是随纬度变化的卯酉圈曲率半径；

a,b是地球椭球的长短轴，是大地测量学中的已知常量；

e是偏心率，是定值；

(d) 根据地球上任何一个点的经度φ _i 、纬度θ _i 和高程 h_i 得到该点地心坐标系坐标 T_0i=[X_0i Y_0i Z_0i]^T

利用大地测量学中经典的转换公式

得到T_0i；

其中

h_i是点离地面高度

N 是随纬度变化的卯酉圈曲率半径；

a,b是地球椭球的长短轴，是大地测量学中的已知常量；

e是偏心率，是定值；

如果已知一个物体所在经纬度φ_i和θ_i，通过本步骤计算出它的地心坐标系坐标T_0i；

(e) 地心坐标系坐标 T_0i 转换为局部坐标系中的坐标 (X_i Y_i Z_i)^T

∆T是局部坐标系中智能机显示屏的几何中心相对于智能机GPS接收天线的局部坐标系偏移。

6.根据权利要求3所述的方法，其特征在于:

权利要求3步骤2)中当手指滑动的时候，根据手指滑动速度大小给予一个初速度{V_x,V_y,V_z}，Xd,Yd,Zd将不停地增加速度分量V_x,V_y,V_z，此过程中让速度分量V_x,V_y,V_z随时间推移不断衰减，其中V_Z在权利要求3步骤2)模式(1)或（2）情况下恒等于零；

让速度体现到局部坐标系下的漫游位移

X_d增加Vx

Y_d增加Vy

Z_d增加Vz

漫游观察者在虚拟场景中移动过程中速度大小不断衰减，

采用以下方法使V_x,V_y,V_z不停地衰减：

运动过程中Vx自身不断地乘以k，直到Vx减小为0为止；

运动过程中Vy自身不断地乘以k，直到Vy减小为0为止；

运动过程中Vz自身不断地乘以k，直到Vz减小为0为止；

或者

2) 运动过程中Vx, Vy, Vz自身分别不断地进行以下增量操作

Vx自身不断地增加-Vx*k，直到Vx减小为0为止；

Vy自身不断地增加-Vy*k，直到Vy减小为0为止；

Vz自身不断地增加-Vz*k，直到Vz减小为0为止；

其中k=0.0001~0.5

以上修改Xd,Yd,Zd及Vx,Vy,Vz的过程不断循环即实现局部加速度漫游效果。

7. 根据权利要求3所述的方法，其特征在于：

在步骤3)和步骤4)之间或在步骤4)之后，将智能机的显示屏设定为二维绘图模式并设置若干个二维标签，针对每一个二维标签，按如下步骤显示：

1）首先确定二维标签的中心位置u,v;

Z_O=

式中： c_x,c_y是智能机显示屏中心点的坐标，若显示屏是矩形,cx=屏宽/2, cy=屏高/2；

r₁₁~r₃₃是R矩阵对应行列的元素；

f= h是显示屏上下边缘垂直像素长，是漫游观察者自身观察的垂直视场角

X_d,Y_d,Z_d是漫游观察者在局部坐标系中的坐标；

如果满足Z_O>0且u,v在显示屏范围内，则u,v保持不变,

否则需要按下法修正u,v

若Z_O=0则将[u v]替换为从点(c_x,c_y)出发

方向的射线与显示屏边缘相交的2维点；若Z_O>0则将u,v替换成从点(c_x,c_y)到点(u,v)的连线与显示屏边缘相交的2维点；若Z_O<0则将u,v替换成从点(u,v)到点(c_x,c_y)延长线与显示屏边缘相交的2维点；

如果二维标签不是用于标注目标，u,v为显示屏范围内的一个由界面设计者设定的像素坐标，或是用户手指触摸或鼠标点击的显示屏像素坐标；

2）按下述方法（1）或（2）计算矢量{Qx,Qy}

方法(1)Qx=-r₂₃/La Qy=r₁₃/La

La=

Qx=-ay/La Qy=ax/La, La=

3）在二维平面上经过以下矩阵旋转变换以后再绘制二维标签：

二维标签上每一点X，经过上式变换到坐标X’显示出来；

式中取+是正放显示，取-是倒放显示，标签的水平轴始终平行于地面。

8.根据权利要求3所述的方法，其特征在于：

所述三维场景为一个空心的三维形体，三维形体为空心球，空心立方体、空心柱体、空心正多面体或空心锥体，三维形体的内壁以全景图作为纹理进行渲染；所述漫游观察者在虚拟场景中位于三维形体内部的某一点，从三维形体内部观察三维形体的内壁，实现利用智能机显示屏姿态控制全景浏览。

9.控制局部坐标系中三维物体姿态的方法，其特征在于：

(1) 按权利要求1方法得到的智能机姿态矩阵Rg；

（2）利用智能机姿态矩阵Rg控制局部坐标系中三维物体的姿态：

在绘制三维物体之前,将R_g矩阵设定为仿真软件系统中的模型转换矩阵M₄₄的左上角3x3矩阵M₄₄=

即实现利用智能机姿态控制局部坐标系中三维物体的姿态。