1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
|
/* -*- Mode: C++; tab-width: 8; indent-tabs-mode: nil; c-basic-offset: 2 -*- */
/* vim: set ts=8 sts=2 et sw=2 tw=80: */
/* This Source Code Form is subject to the terms of the Mozilla Public
* License, v. 2.0. If a copy of the MPL was not distributed with this
* file, You can obtain one at http://mozilla.org/MPL/2.0/. */
#include <math.h>
#include "gfxVR.h"
#ifndef M_PI
# define M_PI 3.14159265358979323846
#endif
using namespace mozilla;
using namespace mozilla::gfx;
Matrix4x4 VRFieldOfView::ConstructProjectionMatrix(float zNear, float zFar,
bool rightHanded) const {
float upTan = tan(upDegrees * M_PI / 180.0);
float downTan = tan(downDegrees * M_PI / 180.0);
float leftTan = tan(leftDegrees * M_PI / 180.0);
float rightTan = tan(rightDegrees * M_PI / 180.0);
float handednessScale = rightHanded ? -1.0 : 1.0;
float pxscale = 2.0f / (leftTan + rightTan);
float pxoffset = (leftTan - rightTan) * pxscale * 0.5;
float pyscale = 2.0f / (upTan + downTan);
float pyoffset = (upTan - downTan) * pyscale * 0.5;
Matrix4x4 mobj;
float* m = &mobj._11;
m[0 * 4 + 0] = pxscale;
m[2 * 4 + 0] = pxoffset * handednessScale;
m[1 * 4 + 1] = pyscale;
m[2 * 4 + 1] = -pyoffset * handednessScale;
m[2 * 4 + 2] = zFar / (zNear - zFar) * -handednessScale;
m[3 * 4 + 2] = (zFar * zNear) / (zNear - zFar);
m[2 * 4 + 3] = handednessScale;
m[3 * 4 + 3] = 0.0f;
return mobj;
}
void VRHMDSensorState::CalcViewMatrices(
const gfx::Matrix4x4* aHeadToEyeTransforms) {
gfx::Matrix4x4 matHead;
if (flags & VRDisplayCapabilityFlags::Cap_Orientation) {
matHead.SetRotationFromQuaternion(
gfx::Quaternion(-pose.orientation[0], -pose.orientation[1],
-pose.orientation[2], pose.orientation[3]));
}
matHead.PreTranslate(-pose.position[0], -pose.position[1], -pose.position[2]);
gfx::Matrix4x4 matView =
matHead * aHeadToEyeTransforms[VRDisplayState::Eye_Left];
matView.Normalize();
memcpy(leftViewMatrix, matView.components, sizeof(matView.components));
matView = matHead * aHeadToEyeTransforms[VRDisplayState::Eye_Right];
matView.Normalize();
memcpy(rightViewMatrix, matView.components, sizeof(matView.components));
}
const IntSize VRDisplayInfo::SuggestedEyeResolution() const {
return IntSize(mDisplayState.eyeResolution.width,
mDisplayState.eyeResolution.height);
}
const Point3D VRDisplayInfo::GetEyeTranslation(uint32_t whichEye) const {
return Point3D(mDisplayState.eyeTranslation[whichEye].x,
mDisplayState.eyeTranslation[whichEye].y,
mDisplayState.eyeTranslation[whichEye].z);
}
const Size VRDisplayInfo::GetStageSize() const {
return Size(mDisplayState.stageSize.width, mDisplayState.stageSize.height);
}
const Matrix4x4 VRDisplayInfo::GetSittingToStandingTransform() const {
Matrix4x4 m;
// If we could replace Matrix4x4 with a pod type, we could
// use it directly from the VRDisplayInfo struct.
memcpy(m.components, mDisplayState.sittingToStandingTransform,
sizeof(float) * 16);
return m;
}
|
