blob: 97b2448b5763f66fdc18d3442745284c0ef100f1 (
plain)
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
|
/********************************************************************************
* FaceTrackNoIR This program is a private project of some enthusiastic *
* gamers from Holland, who don't like to pay much for *
* head-tracking. *
* *
* Copyright (C) 2012 Wim Vriend (Developing) *
* Ron Hendriks (Researching and Testing) *
* *
* Homepage: http://facetracknoir.sourceforge.net/home/default.htm *
* *
* This program is free software; you can redistribute it and/or modify it *
* under the terms of the GNU General Public License as published by the *
* Free Software Foundation; either version 3 of the License, or (at your *
* option) any later version. *
* *
* This program is distributed in the hope that it will be useful, but *
* WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY *
* or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for *
* more details. *
* *
* You should have received a copy of the GNU General Public License along *
* with this program; if not, see <http://www.gnu.org/licenses/>. *
* *
********************************************************************************/
#include "ftnoir_tracker_udp.h"
#include "facetracknoir/global-settings.h"
FTNoIR_Tracker::FTNoIR_Tracker() : should_quit(false)
{
should_quit = false;
for (int i = 0; i < 6; i++)
newHeadPose[i] = 0;
}
FTNoIR_Tracker::~FTNoIR_Tracker()
{
should_quit = true;
wait();
}
void FTNoIR_Tracker::run() {
forever {
if (should_quit)
break;
while (inSocket.hasPendingDatagrams()) {
QMutexLocker foo(&mutex);
QByteArray datagram;
datagram.resize(sizeof(newHeadPose));
inSocket.readDatagram((char * ) newHeadPose, sizeof(double[6]));
}
usleep(10000);
}
}
void FTNoIR_Tracker::StartTracker(QFrame*)
{
(void) inSocket.bind(QHostAddress::Any, (int) s.port, QUdpSocket::ShareAddress | QUdpSocket::ReuseAddressHint);
start();
}
void FTNoIR_Tracker::GetHeadPoseData(double *data)
{
QMutexLocker foo(&mutex);
if (s.enable_x)
data[TX] = newHeadPose[TX];
if (s.enable_y)
data[TY] = newHeadPose[TY];
if (s.enable_z)
data[TZ] = newHeadPose[TZ];
if (s.enable_yaw)
data[Yaw] = newHeadPose[Yaw];
if (s.enable_pitch)
data[Pitch] = newHeadPose[Pitch];
if (s.enable_roll)
data[Roll] = newHeadPose[Roll];
}
extern "C" FTNOIR_TRACKER_BASE_EXPORT ITracker* CALLING_CONVENTION GetConstructor()
{
return new FTNoIR_Tracker;
}
|
