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
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
|
/************************************************************************************
Filename : Vision_SensorStateReader.h
Content : Separate reader component that is able to recover sensor pose
Created : June 4, 2014
Authors : Chris Taylor
Copyright : Copyright 2014 Oculus VR, LLC All Rights reserved.
Licensed under the Oculus VR Rift SDK License Version 3.2 (the "License");
you may not use the Oculus VR Rift SDK except in compliance with the License,
which is provided at the time of installation or download, or which
otherwise accompanies this software in either electronic or hard copy form.
You may obtain a copy of the License at
http://www.oculusvr.com/licenses/LICENSE-3.2
Unless required by applicable law or agreed to in writing, the Oculus VR SDK
distributed under the License is distributed on an "AS IS" BASIS,
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
See the License for the specific language governing permissions and
limitations under the License.
*************************************************************************************/
#ifndef OVR_Vision_SensorStateReader_h
#define OVR_Vision_SensorStateReader_h
#include "Kernel/OVR_Lockless.h"
#include "Vision_SensorState.h"
#include "OVR_Profile.h"
// CAPI forward declarations.
struct ovrTrackingState_;
typedef struct ovrTrackingState_ ovrTrackingState;
namespace OVR { namespace Vision {
//-----------------------------------------------------------------------------
// TrackingStateReader
// Full output of tracking reported by GetSensorStateAtTime()
class TrackingState
{
public:
TrackingState() : StatusFlags(0) { }
// C-interop support
TrackingState(const ovrTrackingState& s);
operator ovrTrackingState () const;
// HMD pose information for the requested time.
PoseStatef HeadPose;
// Orientation and position of the external camera, if present.
Posef CameraPose;
// Orientation and position of the camera after alignment with gravity
Posef LeveledCameraPose;
// Most recent sensor data received from the HMD
SensorDataType RawSensorData;
// Sensor status described by ovrStatusBits.
uint32_t StatusFlags;
};
// User interface to retrieve pose from the sensor fusion subsystem
class TrackingStateReader : public NewOverrideBase
{
protected:
const CombinedHmdUpdater* HmdUpdater;
const CameraStateUpdater* CameraUpdater;
// Transform from real-world coordinates to centered coordinates
Posed CenteredFromWorld;
static Posed DefaultWorldFromCentered;
public:
TrackingStateReader();
// Initialize the updaters
void SetUpdaters(const CombinedHmdUpdater *hmd, const CameraStateUpdater *camera);
// Re-centers on the current yaw and translation, taking
// the head-neck model into account.
bool RecenterPose(const Vector3d& neckModeloffset);
// Computes CenteredFromWorld from a worldFromCpf pose and neck model offset
bool ComputeCenteredFromWorld(const Posed& worldFromCpf, const Vector3d& neckModelOffset);
// Get the full dynamical system state of the CPF, which includes velocities and accelerations,
// predicted at a specified absolute point in time.
bool GetTrackingStateAtTime(double absoluteTime, TrackingState& state) const;
// Get the predicted pose (orientation, position) of the center pupil frame (CPF) at a specific point in time.
bool GetPoseAtTime(double absoluteTime, Posef& transform) const;
// Get the sensor status (same as GetSensorStateAtTime(...).Status)
uint32_t GetStatus() const;
Posed GetCenteredFromWorld() const
{
return CenteredFromWorld;
}
Posed GetDefaultCenteredFromWorld() const
{
return DefaultWorldFromCentered.Inverted();
}
};
}} // namespace OVR::Vision
#endif // Vision_SensorStateReader_h
|