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
|
#include "ftnoir_tracker_tobii.h"
#include "api/plugin-api.hpp"
#include "compat/math.hpp"
tobii::~tobii() = default;
module_status tobii::start_tracker(QFrame*)
{
t.start();
return status_ok();
}
void tobii::data(double *data)
{
if (t.head_pose) {
tobii_head_pose_t p = *t.head_pose;
if (p.position_validity == TOBII_VALIDITY_VALID) {
if (center_pose.position_validity == TOBII_VALIDITY_VALID) {
p.position_xyz[0] = p.position_xyz[0] - center_pose.position_xyz[0];
p.position_xyz[1] = p.position_xyz[1] - center_pose.position_xyz[1];
p.position_xyz[2] = p.position_xyz[2] - center_pose.position_xyz[2];
}
else {
center_pose = p;
}
data[0] = std::clamp(p.position_xyz[0] * 30.0 / 300.0, -30.0, 30.0);
data[1] = std::clamp(p.position_xyz[1] * 30.0 / 300.0, -30.0, 30.0);
data[2] = std::clamp(p.position_xyz[2] * 30.0 / 300.0, -30.0, 30.0);
}
double max_yaw = 90.0;
if (p.rotation_validity_xyz[1] == TOBII_VALIDITY_VALID) {
if (center_pose.rotation_validity_xyz[1] == TOBII_VALIDITY_VALID) {
p.rotation_xyz[1] = p.rotation_xyz[1] - center_pose.rotation_xyz[1];
}
data[3] = std::clamp(p.rotation_xyz[1] * 100.0 * max_yaw / 90.0, -max_yaw, max_yaw);
}
double max_pitch = 90.0;
if (p.rotation_validity_xyz[0] == TOBII_VALIDITY_VALID) {
if (center_pose.rotation_validity_xyz[0] == TOBII_VALIDITY_VALID) {
p.rotation_xyz[0] = p.rotation_xyz[0] - center_pose.rotation_xyz[0];
}
data[4] = std::clamp(p.rotation_xyz[0] * 100.0 * max_pitch / 90.0, -max_pitch, max_pitch);
}
double max_roll = 90.0;
if (p.rotation_validity_xyz[2] == TOBII_VALIDITY_VALID) {
if (center_pose.rotation_validity_xyz[2] == TOBII_VALIDITY_VALID) {
p.rotation_xyz[2] = p.rotation_xyz[2] - center_pose.rotation_xyz[2];
}
data[5] = std::clamp(p.rotation_xyz[2] * 100.0 * max_roll / 90.0, -max_roll, max_roll);
}
}
}
bool tobii::center ()
{
if (t.head_pose) {
center_pose = *t.head_pose;
}
return false;
}
OPENTRACK_DECLARE_TRACKER(tobii, dialog_tobii, tobiiDll)
|
